On Thu, Dec 29, 2016 at 3:32 PM, Harry Wentland <harry.wentland at amd.com> wrote: > Change-Id: I64091fb73045de6bab274ae119e9091ec4d666ff > Signed-off-by: Harry Wentland <harry.wentland at amd.com> Acked-by: Alex Deucher <alexander.deucher at amd.com> > --- > drivers/gpu/drm/amd/display/modules/color/color.c | 2825 -------------------- > .../drm/amd/display/modules/color/color_helper.c | 210 -- > .../drm/amd/display/modules/color/color_helper.h | 62 - > .../gpu/drm/amd/display/modules/inc/mod_color.h | 282 -- > .../gpu/drm/amd/display/modules/inc/mod_power.h | 112 - > drivers/gpu/drm/amd/display/modules/power/power.c | 784 ------ > 6 files changed, 4275 deletions(-) > delete mode 100644 drivers/gpu/drm/amd/display/modules/color/color.c > delete mode 100644 drivers/gpu/drm/amd/display/modules/color/color_helper.c > delete mode 100644 drivers/gpu/drm/amd/display/modules/color/color_helper.h > delete mode 100644 drivers/gpu/drm/amd/display/modules/inc/mod_color.h > delete mode 100644 drivers/gpu/drm/amd/display/modules/inc/mod_power.h > delete mode 100644 drivers/gpu/drm/amd/display/modules/power/power.c > > diff --git a/drivers/gpu/drm/amd/display/modules/color/color.c b/drivers/gpu/drm/amd/display/modules/color/color.c > deleted file mode 100644 > index 74298c8aad8d..000000000000 > --- a/drivers/gpu/drm/amd/display/modules/color/color.c > +++ /dev/null > @@ -1,2825 +0,0 @@ > -/* > - * Copyright 2016 Advanced Micro Devices, Inc. > - * > - * Permission is hereby granted, free of charge, to any person obtaining a > - * copy of this software and associated documentation files (the "Software"), > - * to deal in the Software without restriction, including without limitation > - * the rights to use, copy, modify, merge, publish, distribute, sublicense, > - * and/or sell copies of the Software, and to permit persons to whom the > - * Software is furnished to do so, subject to the following conditions: > - * > - * The above copyright notice and this permission notice shall be included in > - * all copies or substantial portions of the Software. > - * > - * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR > - * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, > - * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL > - * THE COPYRIGHT HOLDER(S) OR AUTHOR(S) BE LIABLE FOR ANY CLAIM, DAMAGES OR > - * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, > - * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR > - * OTHER DEALINGS IN THE SOFTWARE. > - * > - * Authors: AMD > - * > - */ > - > -#include "dm_services.h" > -#include "dc.h" > -#include "mod_color.h" > -#include "core_types.h" > -#include "fixed31_32.h" > -#include "core_dc.h" > - > -#define MOD_COLOR_MAX_CONCURRENT_SINKS 32 > -#define DIVIDER 10000 > -/* S2D13 value in [-3.00...0.9999] */ > -#define S2D13_MIN (-3 * DIVIDER) > -#define S2D13_MAX (3 * DIVIDER) > -#define S0D13_MIN (-1 * DIVIDER) > -#define S0D13_MAX (1 * DIVIDER) > - > -struct sink_caps { > - const struct dc_sink *sink; > -}; > - > -struct gamut_calculation_matrix { > - struct fixed31_32 MTransposed[9]; > - struct fixed31_32 XYZtoRGB_Custom[9]; > - struct fixed31_32 XYZtoRGB_Ref[9]; > - struct fixed31_32 RGBtoXYZ_Final[9]; > - > - struct fixed31_32 MResult[9]; > - struct fixed31_32 fXYZofWhiteRef[9]; > - struct fixed31_32 fXYZofRGBRef[9]; > -}; > - > -struct gamut_src_dst_matrix { > - struct fixed31_32 rgbCoeffDst[9]; > - struct fixed31_32 whiteCoeffDst[3]; > - struct fixed31_32 rgbCoeffSrc[9]; > - struct fixed31_32 whiteCoeffSrc[3]; > -}; > - > -struct color_state { > - bool user_enable_color_temperature; > - int custom_color_temperature; > - struct color_range contrast; > - struct color_range saturation; > - struct color_range brightness; > - struct color_range hue; > - struct dc_gamma *gamma; > - enum dc_quantization_range preferred_quantization_range; > - > - struct color_gamut_data source_gamut; > - struct color_gamut_data destination_gamut; > - enum color_transfer_func input_transfer_function; > - enum color_transfer_func output_transfer_function; > - struct dc_hdr_static_metadata mastering_info; > -}; > - > -struct core_color { > - struct mod_color public; > - struct dc *dc; > - int num_sinks; > - struct sink_caps *caps; > - struct color_state *state; > - struct color_edid_caps *edid_caps; > -}; > - > -#define MOD_COLOR_TO_CORE(mod_color)\ > - container_of(mod_color, struct core_color, public) > - > -#define COLOR_REGISTRY_NAME "color_v1" > - > -/*Matrix Calculation Functions*/ > -/** > - ***************************************************************************** > - * Function: transposeMatrix > - * > - * @brief > - * rotate the matrix 90 degrees clockwise > - * rows become a columns and columns to rows > - * @param [ in ] M - source matrix > - * @param [ in ] Rows - num of Rows of the original matrix > - * @param [ in ] Cols - num of Cols of the original matrix > - * @param [ out] MTransposed - result matrix > - * @return void > - * > - ***************************************************************************** > - */ > -static void transpose_matrix(const struct fixed31_32 *M, unsigned int Rows, > - unsigned int Cols, struct fixed31_32 *MTransposed) > -{ > - unsigned int i, j; > - > - for (i = 0; i < Rows; i++) { > - for (j = 0; j < Cols; j++) > - MTransposed[(j*Rows)+i] = M[(i*Cols)+j]; > - } > -} > - > -/** > - ***************************************************************************** > - * Function: multiplyMatrices > - * > - * @brief > - * multiplies produce of two matrices: M = M1[ulRows1 x ulCols1] * > - * M2[ulCols1 x ulCols2]. > - * > - * @param [ in ] M1 - first Matrix. > - * @param [ in ] M2 - second Matrix. > - * @param [ in ] Rows1 - num of Rows of the first Matrix > - * @param [ in ] Cols1 - num of Cols of the first Matrix/Num of Rows > - * of the second Matrix > - * @param [ in ] Cols2 - num of Cols of the second Matrix > - * @param [out ] mResult - resulting matrix. > - * @return void > - * > - ***************************************************************************** > - */ > -static void multiply_matrices(struct fixed31_32 *mResult, > - const struct fixed31_32 *M1, > - const struct fixed31_32 *M2, unsigned int Rows1, > - unsigned int Cols1, unsigned int Cols2) > -{ > - unsigned int i, j, k; > - > - for (i = 0; i < Rows1; i++) { > - for (j = 0; j < Cols2; j++) { > - mResult[(i * Cols2) + j] = dal_fixed31_32_zero; > - for (k = 0; k < Cols1; k++) > - mResult[(i * Cols2) + j] = > - dal_fixed31_32_add > - (mResult[(i * Cols2) + j], > - dal_fixed31_32_mul(M1[(i * Cols1) + k], > - M2[(k * Cols2) + j])); > - } > - } > -} > - > -/** > - ***************************************************************************** > - * Function: cFind3X3Det > - * > - * @brief > - * finds determinant of given 3x3 matrix > - * > - * @param [ in ] m - matrix > - * @return determinate whioch could not be zero > - * > - ***************************************************************************** > - */ > -static struct fixed31_32 find_3X3_det(const struct fixed31_32 *m) > -{ > - struct fixed31_32 det, A1, A2, A3; > - > - A1 = dal_fixed31_32_mul(m[0], > - dal_fixed31_32_sub(dal_fixed31_32_mul(m[4], m[8]), > - dal_fixed31_32_mul(m[5], m[7]))); > - A2 = dal_fixed31_32_mul(m[1], > - dal_fixed31_32_sub(dal_fixed31_32_mul(m[3], m[8]), > - dal_fixed31_32_mul(m[5], m[6]))); > - A3 = dal_fixed31_32_mul(m[2], > - dal_fixed31_32_sub(dal_fixed31_32_mul(m[3], m[7]), > - dal_fixed31_32_mul(m[4], m[6]))); > - det = dal_fixed31_32_add(dal_fixed31_32_sub(A1, A2), A3); > - return det; > -} > - > - > -/** > - ***************************************************************************** > - * Function: computeInverseMatrix_3x3 > - * > - * @brief > - * builds inverse matrix > - * > - * @param [ in ] m - matrix > - * @param [ out ] im - result matrix > - * @return true if success > - * > - ***************************************************************************** > - */ > -static bool compute_inverse_matrix_3x3(const struct fixed31_32 *m, > - struct fixed31_32 *im) > -{ > - struct fixed31_32 determinant = find_3X3_det(m); > - > - if (dal_fixed31_32_eq(determinant, dal_fixed31_32_zero) == false) { > - im[0] = dal_fixed31_32_div(dal_fixed31_32_sub > - (dal_fixed31_32_mul(m[4], m[8]), > - dal_fixed31_32_mul(m[5], m[7])), determinant); > - im[1] = dal_fixed31_32_neg(dal_fixed31_32_div(dal_fixed31_32_sub > - (dal_fixed31_32_mul(m[1], m[8]), > - dal_fixed31_32_mul(m[2], m[7])), determinant)); > - im[2] = dal_fixed31_32_div(dal_fixed31_32_sub > - (dal_fixed31_32_mul(m[1], m[5]), > - dal_fixed31_32_mul(m[2], m[4])), determinant); > - im[3] = dal_fixed31_32_neg(dal_fixed31_32_div(dal_fixed31_32_sub > - (dal_fixed31_32_mul(m[3], m[8]), > - dal_fixed31_32_mul(m[5], m[6])), determinant)); > - im[4] = dal_fixed31_32_div(dal_fixed31_32_sub > - (dal_fixed31_32_mul(m[0], m[8]), > - dal_fixed31_32_mul(m[2], m[6])), determinant); > - im[5] = dal_fixed31_32_neg(dal_fixed31_32_div(dal_fixed31_32_sub > - (dal_fixed31_32_mul(m[0], m[5]), > - dal_fixed31_32_mul(m[2], m[3])), determinant)); > - im[6] = dal_fixed31_32_div(dal_fixed31_32_sub > - (dal_fixed31_32_mul(m[3], m[7]), > - dal_fixed31_32_mul(m[4], m[6])), determinant); > - im[7] = dal_fixed31_32_neg(dal_fixed31_32_div(dal_fixed31_32_sub > - (dal_fixed31_32_mul(m[0], m[7]), > - dal_fixed31_32_mul(m[1], m[6])), determinant)); > - im[8] = dal_fixed31_32_div(dal_fixed31_32_sub > - (dal_fixed31_32_mul(m[0], m[4]), > - dal_fixed31_32_mul(m[1], m[3])), determinant); > - return true; > - } > - return false; > -} > - > -/** > - ***************************************************************************** > - * Function: calculateXYZtoRGB_M3x3 > - * > - * @brief > - * Calculates transformation matrix from XYZ coordinates to RBG > - * > - * @param [ in ] XYZofRGB - primaries XYZ > - * @param [ in ] XYZofWhite - white point. > - * @param [ out ] XYZtoRGB - RGB primires > - * @return true if success > - * > - ***************************************************************************** > - */ > -static bool calculate_XYZ_to_RGB_3x3(const struct fixed31_32 *XYZofRGB, > - const struct fixed31_32 *XYZofWhite, > - struct fixed31_32 *XYZtoRGB) > -{ > - > - struct fixed31_32 MInversed[9]; > - struct fixed31_32 SVector[3]; > - > - /*1. Find Inverse matrix 3x3 of MTransposed*/ > - if (!compute_inverse_matrix_3x3(XYZofRGB, MInversed)) > - return false; > - > - /*2. Calculate vector: |Sr Sg Sb| = [MInversed] * |Wx Wy Wz|*/ > - multiply_matrices(SVector, MInversed, XYZofWhite, 3, 3, 1); > - > - /*3. Calculate matrix XYZtoRGB 3x3*/ > - XYZtoRGB[0] = dal_fixed31_32_mul(XYZofRGB[0], SVector[0]); > - XYZtoRGB[1] = dal_fixed31_32_mul(XYZofRGB[1], SVector[1]); > - XYZtoRGB[2] = dal_fixed31_32_mul(XYZofRGB[2], SVector[2]); > - > - XYZtoRGB[3] = dal_fixed31_32_mul(XYZofRGB[3], SVector[0]); > - XYZtoRGB[4] = dal_fixed31_32_mul(XYZofRGB[4], SVector[1]); > - XYZtoRGB[5] = dal_fixed31_32_mul(XYZofRGB[5], SVector[2]); > - > - XYZtoRGB[6] = dal_fixed31_32_mul(XYZofRGB[6], SVector[0]); > - XYZtoRGB[7] = dal_fixed31_32_mul(XYZofRGB[7], SVector[1]); > - XYZtoRGB[8] = dal_fixed31_32_mul(XYZofRGB[8], SVector[2]); > - > - return true; > -} > - > -static bool gamut_to_color_matrix( > - const struct fixed31_32 *pXYZofRGB,/*destination gamut*/ > - const struct fixed31_32 *pXYZofWhite,/*destination of white point*/ > - const struct fixed31_32 *pRefXYZofRGB,/*source gamut*/ > - const struct fixed31_32 *pRefXYZofWhite,/*source of white point*/ > - bool invert, > - struct fixed31_32 *tempMatrix3X3) > -{ > - int i = 0; > - struct gamut_calculation_matrix *matrix = > - dm_alloc(sizeof(struct gamut_calculation_matrix)); > - > - struct fixed31_32 *pXYZtoRGB_Temp; > - struct fixed31_32 *pXYZtoRGB_Final; > - > - matrix->fXYZofWhiteRef[0] = pRefXYZofWhite[0]; > - matrix->fXYZofWhiteRef[1] = pRefXYZofWhite[1]; > - matrix->fXYZofWhiteRef[2] = pRefXYZofWhite[2]; > - > - > - matrix->fXYZofRGBRef[0] = pRefXYZofRGB[0]; > - matrix->fXYZofRGBRef[1] = pRefXYZofRGB[1]; > - matrix->fXYZofRGBRef[2] = pRefXYZofRGB[2]; > - > - matrix->fXYZofRGBRef[3] = pRefXYZofRGB[3]; > - matrix->fXYZofRGBRef[4] = pRefXYZofRGB[4]; > - matrix->fXYZofRGBRef[5] = pRefXYZofRGB[5]; > - > - matrix->fXYZofRGBRef[6] = pRefXYZofRGB[6]; > - matrix->fXYZofRGBRef[7] = pRefXYZofRGB[7]; > - matrix->fXYZofRGBRef[8] = pRefXYZofRGB[8]; > - > - /*default values - unity matrix*/ > - while (i < 9) { > - if (i == 0 || i == 4 || i == 8) > - tempMatrix3X3[i] = dal_fixed31_32_one; > - else > - tempMatrix3X3[i] = dal_fixed31_32_zero; > - i++; > - } > - > - /*1. Decide about the order of calculation. > - * bInvert == FALSE --> RGBtoXYZ_Ref * XYZtoRGB_Custom > - * bInvert == TRUE --> RGBtoXYZ_Custom * XYZtoRGB_Ref */ > - if (invert) { > - pXYZtoRGB_Temp = matrix->XYZtoRGB_Custom; > - pXYZtoRGB_Final = matrix->XYZtoRGB_Ref; > - } else { > - pXYZtoRGB_Temp = matrix->XYZtoRGB_Ref; > - pXYZtoRGB_Final = matrix->XYZtoRGB_Custom; > - } > - > - /*2. Calculate XYZtoRGB_Ref*/ > - transpose_matrix(matrix->fXYZofRGBRef, 3, 3, matrix->MTransposed); > - > - if (!calculate_XYZ_to_RGB_3x3( > - matrix->MTransposed, > - matrix->fXYZofWhiteRef, > - matrix->XYZtoRGB_Ref)) > - goto function_fail; > - > - /*3. Calculate XYZtoRGB_Custom*/ > - transpose_matrix(pXYZofRGB, 3, 3, matrix->MTransposed); > - > - if (!calculate_XYZ_to_RGB_3x3( > - matrix->MTransposed, > - pXYZofWhite, > - matrix->XYZtoRGB_Custom)) > - goto function_fail; > - > - /*4. Calculate RGBtoXYZ - > - * inverse matrix 3x3 of XYZtoRGB_Ref or XYZtoRGB_Custom*/ > - if (!compute_inverse_matrix_3x3(pXYZtoRGB_Temp, matrix->RGBtoXYZ_Final)) > - goto function_fail; > - > - /*5. Calculate M(3x3) = RGBtoXYZ * XYZtoRGB*/ > - multiply_matrices(matrix->MResult, matrix->RGBtoXYZ_Final, > - pXYZtoRGB_Final, 3, 3, 3); > - > - for (i = 0; i < 9; i++) > - tempMatrix3X3[i] = matrix->MResult[i]; > - > - dm_free(matrix); > - > - return true; > - > -function_fail: > - dm_free(matrix); > - return false; > -} > - > -static bool build_gamut_remap_matrix > - (struct color_space_coordinates gamut_description, > - struct fixed31_32 *rgb_matrix, > - struct fixed31_32 *white_point_matrix) > -{ > - struct fixed31_32 fixed_blueX = dal_fixed31_32_from_fraction > - (gamut_description.blueX, DIVIDER); > - struct fixed31_32 fixed_blueY = dal_fixed31_32_from_fraction > - (gamut_description.blueY, DIVIDER); > - struct fixed31_32 fixed_greenX = dal_fixed31_32_from_fraction > - (gamut_description.greenX, DIVIDER); > - struct fixed31_32 fixed_greenY = dal_fixed31_32_from_fraction > - (gamut_description.greenY, DIVIDER); > - struct fixed31_32 fixed_redX = dal_fixed31_32_from_fraction > - (gamut_description.redX, DIVIDER); > - struct fixed31_32 fixed_redY = dal_fixed31_32_from_fraction > - (gamut_description.redY, DIVIDER); > - struct fixed31_32 fixed_whiteX = dal_fixed31_32_from_fraction > - (gamut_description.whiteX, DIVIDER); > - struct fixed31_32 fixed_whiteY = dal_fixed31_32_from_fraction > - (gamut_description.whiteY, DIVIDER); > - > - rgb_matrix[0] = dal_fixed31_32_div(fixed_redX, fixed_redY); > - rgb_matrix[1] = dal_fixed31_32_one; > - rgb_matrix[2] = dal_fixed31_32_div(dal_fixed31_32_sub > - (dal_fixed31_32_sub(dal_fixed31_32_one, fixed_redX), > - fixed_redY), fixed_redY); > - > - rgb_matrix[3] = dal_fixed31_32_div(fixed_greenX, fixed_greenY); > - rgb_matrix[4] = dal_fixed31_32_one; > - rgb_matrix[5] = dal_fixed31_32_div(dal_fixed31_32_sub > - (dal_fixed31_32_sub(dal_fixed31_32_one, fixed_greenX), > - fixed_greenY), fixed_greenY); > - > - rgb_matrix[6] = dal_fixed31_32_div(fixed_blueX, fixed_blueY); > - rgb_matrix[7] = dal_fixed31_32_one; > - rgb_matrix[8] = dal_fixed31_32_div(dal_fixed31_32_sub > - (dal_fixed31_32_sub(dal_fixed31_32_one, fixed_blueX), > - fixed_blueY), fixed_blueY); > - > - white_point_matrix[0] = dal_fixed31_32_div(fixed_whiteX, fixed_whiteY); > - white_point_matrix[1] = dal_fixed31_32_one; > - white_point_matrix[2] = dal_fixed31_32_div(dal_fixed31_32_sub > - (dal_fixed31_32_sub(dal_fixed31_32_one, fixed_whiteX), > - fixed_whiteY), fixed_whiteY); > - > - return true; > -} > - > -static bool check_dc_support(const struct dc *dc) > -{ > - if (dc->stream_funcs.set_gamut_remap == NULL) > - return false; > - > - return true; > -} > - > -static uint16_t fixed_point_to_int_frac( > - struct fixed31_32 arg, > - uint8_t integer_bits, > - uint8_t fractional_bits) > -{ > - int32_t numerator; > - int32_t divisor = 1 << fractional_bits; > - > - uint16_t result; > - > - uint16_t d = (uint16_t)dal_fixed31_32_floor( > - dal_fixed31_32_abs( > - arg)); > - > - if (d <= (uint16_t)(1 << integer_bits) - (1 / (uint16_t)divisor)) > - numerator = (uint16_t)dal_fixed31_32_floor( > - dal_fixed31_32_mul_int( > - arg, > - divisor)); > - else { > - numerator = dal_fixed31_32_floor( > - dal_fixed31_32_sub( > - dal_fixed31_32_from_int( > - 1LL << integer_bits), > - dal_fixed31_32_recip( > - dal_fixed31_32_from_int( > - divisor)))); > - } > - > - if (numerator >= 0) > - result = (uint16_t)numerator; > - else > - result = (uint16_t)( > - (1 << (integer_bits + fractional_bits + 1)) + numerator); > - > - if ((result != 0) && dal_fixed31_32_lt( > - arg, dal_fixed31_32_zero)) > - result |= 1 << (integer_bits + fractional_bits); > - > - return result; > -} > - > -/** > -* convert_float_matrix > -* This converts a double into HW register spec defined format S2D13. > -* @param : > -* @return None > -*/ > - > -static void convert_float_matrix_legacy( > - uint16_t *matrix, > - struct fixed31_32 *flt, > - uint32_t buffer_size) > -{ > - const struct fixed31_32 min_2_13 = > - dal_fixed31_32_from_fraction(S2D13_MIN, DIVIDER); > - const struct fixed31_32 max_2_13 = > - dal_fixed31_32_from_fraction(S2D13_MAX, DIVIDER); > - uint32_t i; > - > - for (i = 0; i < buffer_size; ++i) { > - uint32_t reg_value = > - fixed_point_to_int_frac( > - dal_fixed31_32_clamp( > - flt[i], > - min_2_13, > - max_2_13), > - 2, > - 13); > - > - matrix[i] = (uint16_t)reg_value; > - } > -} > - > -static void convert_float_matrix( > - uint16_t *matrix, > - struct fixed31_32 *flt, > - uint32_t buffer_size) > -{ > - const struct fixed31_32 min_0_13 = > - dal_fixed31_32_from_fraction(S0D13_MIN, DIVIDER); > - const struct fixed31_32 max_0_13 = > - dal_fixed31_32_from_fraction(S0D13_MAX, DIVIDER); > - const struct fixed31_32 min_2_13 = > - dal_fixed31_32_from_fraction(S2D13_MIN, DIVIDER); > - const struct fixed31_32 max_2_13 = > - dal_fixed31_32_from_fraction(S2D13_MAX, DIVIDER); > - uint32_t i; > - uint16_t temp_matrix[12]; > - > - for (i = 0; i < buffer_size; ++i) { > - if (i == 3 || i == 7 || i == 11) { > - uint32_t reg_value = > - fixed_point_to_int_frac( > - dal_fixed31_32_clamp( > - flt[i], > - min_0_13, > - max_0_13), > - 2, > - 13); > - > - temp_matrix[i] = (uint16_t)reg_value; > - } else { > - uint32_t reg_value = > - fixed_point_to_int_frac( > - dal_fixed31_32_clamp( > - flt[i], > - min_2_13, > - max_2_13), > - 2, > - 13); > - > - temp_matrix[i] = (uint16_t)reg_value; > - } > - } > - > - matrix[4] = temp_matrix[0]; > - matrix[5] = temp_matrix[1]; > - matrix[6] = temp_matrix[2]; > - matrix[7] = temp_matrix[3]; > - > - matrix[8] = temp_matrix[4]; > - matrix[9] = temp_matrix[5]; > - matrix[10] = temp_matrix[6]; > - matrix[11] = temp_matrix[7]; > - > - matrix[0] = temp_matrix[8]; > - matrix[1] = temp_matrix[9]; > - matrix[2] = temp_matrix[10]; > - matrix[3] = temp_matrix[11]; > -} > - > -static int get_hw_value_from_sw_value(int swVal, int swMin, > - int swMax, int hwMin, int hwMax) > -{ > - int dSW = swMax - swMin; /*software adjustment range size*/ > - int dHW = hwMax - hwMin; /*hardware adjustment range size*/ > - int hwVal; /*HW adjustment value*/ > - > - /* error case, I preserve the behavior from the predecessor > - *getHwStepFromSwHwMinMaxValue (removed in Feb 2013) > - *which was the FP version that only computed SCLF (i.e. dHW/dSW). > - *it would return 0 in this case so > - *hwVal = hwMin from the formula given in @brief > - */ > - if (dSW == 0) > - return hwMin; > - > - /*it's quite often that ranges match, > - *e.g. for overlay colors currently (Feb 2013) > - *only brightness has a different > - *HW range, and in this case no multiplication or division is needed, > - *and if minimums match, no calculation at all > - */ > - if (dSW != dHW) { > - hwVal = (swVal - swMin)*dHW/dSW + hwMin; > - } else { > - hwVal = swVal; > - if (swMin != hwMin) > - hwVal += (hwMin - swMin); > - } > - > - return hwVal; > -} > - > -static void initialize_fix_point_color_values( > - struct core_color *core_color, > - unsigned int sink_index, > - struct fixed31_32 *grph_cont, > - struct fixed31_32 *grph_sat, > - struct fixed31_32 *grph_bright, > - struct fixed31_32 *sin_grph_hue, > - struct fixed31_32 *cos_grph_hue) > -{ > - /* Hue adjustment could be negative. -45 ~ +45 */ > - struct fixed31_32 hue = > - dal_fixed31_32_mul( > - dal_fixed31_32_from_fraction > - (get_hw_value_from_sw_value > - (core_color->state[sink_index].hue.current, > - core_color->state[sink_index].hue.min, > - core_color->state[sink_index].hue.max, > - -30, 30), 180), > - dal_fixed31_32_pi); > - > - *sin_grph_hue = dal_fixed31_32_sin(hue); > - *cos_grph_hue = dal_fixed31_32_cos(hue); > - > - *grph_cont = > - dal_fixed31_32_from_fraction(get_hw_value_from_sw_value > - (core_color->state[sink_index].contrast.current, > - core_color->state[sink_index].contrast.min, > - core_color->state[sink_index].contrast.max, > - 50, 150), 100); > - *grph_sat = > - dal_fixed31_32_from_fraction(get_hw_value_from_sw_value > - (core_color->state[sink_index].saturation.current, > - core_color->state[sink_index].saturation.min, > - core_color->state[sink_index].saturation.max, > - 0, 200), 100); > - *grph_bright = > - dal_fixed31_32_from_fraction(get_hw_value_from_sw_value > - (core_color->state[sink_index].brightness.current, > - core_color->state[sink_index].brightness.min, > - core_color->state[sink_index].brightness.max, > - -25, 25), 100); > -} > - > - > -/* Given a specific dc_sink* this function finds its equivalent > - * on the dc_sink array and returns the corresponding index > - */ > -static int sink_index_from_sink(struct core_color *core_color, > - const struct dc_sink *sink) > -{ > - int index = 0; > - > - for (index = 0; index < core_color->num_sinks; index++) > - if (core_color->caps[index].sink == sink) > - return index; > - > - /* Could not find sink requested */ > - ASSERT(false); > - return -1; > -} > - > -static void calculate_rgb_matrix_legacy(struct core_color *core_color, > - unsigned int sink_index, > - struct fixed31_32 *rgb_matrix) > -{ > - const struct fixed31_32 k1 = > - dal_fixed31_32_from_fraction(701000, 1000000); > - const struct fixed31_32 k2 = > - dal_fixed31_32_from_fraction(236568, 1000000); > - const struct fixed31_32 k3 = > - dal_fixed31_32_from_fraction(-587000, 1000000); > - const struct fixed31_32 k4 = > - dal_fixed31_32_from_fraction(464432, 1000000); > - const struct fixed31_32 k5 = > - dal_fixed31_32_from_fraction(-114000, 1000000); > - const struct fixed31_32 k6 = > - dal_fixed31_32_from_fraction(-701000, 1000000); > - const struct fixed31_32 k7 = > - dal_fixed31_32_from_fraction(-299000, 1000000); > - const struct fixed31_32 k8 = > - dal_fixed31_32_from_fraction(-292569, 1000000); > - const struct fixed31_32 k9 = > - dal_fixed31_32_from_fraction(413000, 1000000); > - const struct fixed31_32 k10 = > - dal_fixed31_32_from_fraction(-92482, 1000000); > - const struct fixed31_32 k11 = > - dal_fixed31_32_from_fraction(-114000, 1000000); > - const struct fixed31_32 k12 = > - dal_fixed31_32_from_fraction(385051, 1000000); > - const struct fixed31_32 k13 = > - dal_fixed31_32_from_fraction(-299000, 1000000); > - const struct fixed31_32 k14 = > - dal_fixed31_32_from_fraction(886000, 1000000); > - const struct fixed31_32 k15 = > - dal_fixed31_32_from_fraction(-587000, 1000000); > - const struct fixed31_32 k16 = > - dal_fixed31_32_from_fraction(-741914, 1000000); > - const struct fixed31_32 k17 = > - dal_fixed31_32_from_fraction(886000, 1000000); > - const struct fixed31_32 k18 = > - dal_fixed31_32_from_fraction(-144086, 1000000); > - > - const struct fixed31_32 luma_r = > - dal_fixed31_32_from_fraction(299, 1000); > - const struct fixed31_32 luma_g = > - dal_fixed31_32_from_fraction(587, 1000); > - const struct fixed31_32 luma_b = > - dal_fixed31_32_from_fraction(114, 1000); > - > - struct fixed31_32 grph_cont; > - struct fixed31_32 grph_sat; > - struct fixed31_32 grph_bright; > - struct fixed31_32 sin_grph_hue; > - struct fixed31_32 cos_grph_hue; > - > - initialize_fix_point_color_values( > - core_color, sink_index, &grph_cont, &grph_sat, > - &grph_bright, &sin_grph_hue, &cos_grph_hue); > - > - /* COEF_1_1 = GrphCont * (LumaR + GrphSat * (Cos(GrphHue) * K1 +*/ > - /* Sin(GrphHue) * K2))*/ > - /* (Cos(GrphHue) * K1 + Sin(GrphHue) * K2)*/ > - rgb_matrix[0] = > - dal_fixed31_32_add( > - dal_fixed31_32_mul(cos_grph_hue, k1), > - dal_fixed31_32_mul(sin_grph_hue, k2)); > - /* GrphSat * (Cos(GrphHue) * K1 + Sin(GrphHue) * K2 */ > - rgb_matrix[0] = dal_fixed31_32_mul(grph_sat, rgb_matrix[0]); > - /* (LumaR + GrphSat * (Cos(GrphHue) * K1 + Sin(GrphHue) * K2))*/ > - rgb_matrix[0] = dal_fixed31_32_add(luma_r, rgb_matrix[0]); > - /* GrphCont * (LumaR + GrphSat * (Cos(GrphHue) * K1 + Sin(GrphHue)**/ > - /* K2))*/ > - rgb_matrix[0] = dal_fixed31_32_mul(grph_cont, rgb_matrix[0]); > - > - /* COEF_1_2 = GrphCont * (LumaG + GrphSat * (Cos(GrphHue) * K3 +*/ > - /* Sin(GrphHue) * K4))*/ > - /* (Cos(GrphHue) * K3 + Sin(GrphHue) * K4)*/ > - rgb_matrix[1] = > - dal_fixed31_32_add( > - dal_fixed31_32_mul(cos_grph_hue, k3), > - dal_fixed31_32_mul(sin_grph_hue, k4)); > - /* GrphSat * (Cos(GrphHue) * K3 + Sin(GrphHue) * K4)*/ > - rgb_matrix[1] = dal_fixed31_32_mul(grph_sat, rgb_matrix[1]); > - /* (LumaG + GrphSat * (Cos(GrphHue) * K3 + Sin(GrphHue) * K4))*/ > - rgb_matrix[1] = dal_fixed31_32_add(luma_g, rgb_matrix[1]); > - /* GrphCont * (LumaG + GrphSat * (Cos(GrphHue) * K3 + Sin(GrphHue)**/ > - /* K4))*/ > - rgb_matrix[1] = dal_fixed31_32_mul(grph_cont, rgb_matrix[1]); > - > - /* COEF_1_3 = GrphCont * (LumaB + GrphSat * (Cos(GrphHue) * K5 +*/ > - /* Sin(GrphHue) * K6))*/ > - /* (Cos(GrphHue) * K5 + Sin(GrphHue) * K6)*/ > - rgb_matrix[2] = > - dal_fixed31_32_add( > - dal_fixed31_32_mul(cos_grph_hue, k5), > - dal_fixed31_32_mul(sin_grph_hue, k6)); > - /* GrphSat * (Cos(GrphHue) * K5 + Sin(GrphHue) * K6)*/ > - rgb_matrix[2] = dal_fixed31_32_mul(grph_sat, rgb_matrix[2]); > - /* LumaB + GrphSat * (Cos(GrphHue) * K5 + Sin(GrphHue) * K6)*/ > - rgb_matrix[2] = dal_fixed31_32_add(luma_b, rgb_matrix[2]); > - /* GrphCont * (LumaB + GrphSat * (Cos(GrphHue) * K5 + Sin(GrphHue)**/ > - /* K6))*/ > - rgb_matrix[2] = dal_fixed31_32_mul(grph_cont, rgb_matrix[2]); > - > - /* COEF_1_4 = GrphBright*/ > - rgb_matrix[3] = grph_bright; > - > - /* COEF_2_1 = GrphCont * (LumaR + GrphSat * (Cos(GrphHue) * K7 +*/ > - /* Sin(GrphHue) * K8))*/ > - /* (Cos(GrphHue) * K7 + Sin(GrphHue) * K8)*/ > - rgb_matrix[4] = > - dal_fixed31_32_add( > - dal_fixed31_32_mul(cos_grph_hue, k7), > - dal_fixed31_32_mul(sin_grph_hue, k8)); > - /* GrphSat * (Cos(GrphHue) * K7 + Sin(GrphHue) * K8)*/ > - rgb_matrix[4] = dal_fixed31_32_mul(grph_sat, rgb_matrix[4]); > - /* (LumaR + GrphSat * (Cos(GrphHue) * K7 + Sin(GrphHue) * K8))*/ > - rgb_matrix[4] = dal_fixed31_32_add(luma_r, rgb_matrix[4]); > - /* GrphCont * (LumaR + GrphSat * (Cos(GrphHue) * K7 + Sin(GrphHue)**/ > - /* K8))*/ > - rgb_matrix[4] = dal_fixed31_32_mul(grph_cont, rgb_matrix[4]); > - > - /* COEF_2_2 = GrphCont * (LumaG + GrphSat * (Cos(GrphHue) * K9 +*/ > - /* Sin(GrphHue) * K10))*/ > - /* (Cos(GrphHue) * K9 + Sin(GrphHue) * K10))*/ > - rgb_matrix[5] = > - dal_fixed31_32_add( > - dal_fixed31_32_mul(cos_grph_hue, k9), > - dal_fixed31_32_mul(sin_grph_hue, k10)); > - /* GrphSat * (Cos(GrphHue) * K9 + Sin(GrphHue) * K10))*/ > - rgb_matrix[5] = dal_fixed31_32_mul(grph_sat, rgb_matrix[5]); > - /* (LumaG + GrphSat * (Cos(GrphHue) * K9 + Sin(GrphHue) * K10))*/ > - rgb_matrix[5] = dal_fixed31_32_add(luma_g, rgb_matrix[5]); > - /* GrphCont * (LumaG + GrphSat * (Cos(GrphHue) * K9 + Sin(GrphHue)**/ > - /* K10))*/ > - rgb_matrix[5] = dal_fixed31_32_mul(grph_cont, rgb_matrix[5]); > - > - /* COEF_2_3 = GrphCont * (LumaB + GrphSat * (Cos(GrphHue) * K11 +*/ > - /* Sin(GrphHue) * K12))*/ > - /* (Cos(GrphHue) * K11 + Sin(GrphHue) * K12))*/ > - rgb_matrix[6] = > - dal_fixed31_32_add( > - dal_fixed31_32_mul(cos_grph_hue, k11), > - dal_fixed31_32_mul(sin_grph_hue, k12)); > - /* GrphSat * (Cos(GrphHue) * K11 + Sin(GrphHue) * K12))*/ > - rgb_matrix[6] = dal_fixed31_32_mul(grph_sat, rgb_matrix[6]); > - /* (LumaB + GrphSat * (Cos(GrphHue) * K11 + Sin(GrphHue) * K12))*/ > - rgb_matrix[6] = dal_fixed31_32_add(luma_b, rgb_matrix[6]); > - /* GrphCont * (LumaB + GrphSat * (Cos(GrphHue) * K11 + Sin(GrphHue)**/ > - /* K12))*/ > - rgb_matrix[6] = dal_fixed31_32_mul(grph_cont, rgb_matrix[6]); > - > - /* COEF_2_4 = GrphBright*/ > - rgb_matrix[7] = grph_bright; > - > - /* COEF_3_1 = GrphCont * (LumaR + GrphSat * (Cos(GrphHue) * K13 +*/ > - /* Sin(GrphHue) * K14))*/ > - /* (Cos(GrphHue) * K13 + Sin(GrphHue) * K14)) */ > - rgb_matrix[8] = > - dal_fixed31_32_add( > - dal_fixed31_32_mul(cos_grph_hue, k13), > - dal_fixed31_32_mul(sin_grph_hue, k14)); > - /* GrphSat * (Cos(GrphHue) * K13 + Sin(GrphHue) * K14)) */ > - rgb_matrix[8] = dal_fixed31_32_mul(grph_sat, rgb_matrix[8]); > - /* (LumaR + GrphSat * (Cos(GrphHue) * K13 + Sin(GrphHue) * K14)) */ > - rgb_matrix[8] = dal_fixed31_32_add(luma_r, rgb_matrix[8]); > - /* GrphCont * (LumaR + GrphSat * (Cos(GrphHue) * K13 + Sin(GrphHue)**/ > - /* K14)) */ > - rgb_matrix[8] = dal_fixed31_32_mul(grph_cont, rgb_matrix[8]); > - > - /* COEF_3_2 = GrphCont * (LumaG + GrphSat * (Cos(GrphHue) * K15 +*/ > - /* Sin(GrphHue) * K16)) */ > - /* GrphSat * (Cos(GrphHue) * K15 + Sin(GrphHue) * K16) */ > - rgb_matrix[9] = > - dal_fixed31_32_add( > - dal_fixed31_32_mul(cos_grph_hue, k15), > - dal_fixed31_32_mul(sin_grph_hue, k16)); > - /* (LumaG + GrphSat * (Cos(GrphHue) * K15 + Sin(GrphHue) * K16)) */ > - rgb_matrix[9] = dal_fixed31_32_mul(grph_sat, rgb_matrix[9]); > - /* (LumaG + GrphSat * (Cos(GrphHue) * K15 + Sin(GrphHue) * K16)) */ > - rgb_matrix[9] = dal_fixed31_32_add(luma_g, rgb_matrix[9]); > - /* GrphCont * (LumaG + GrphSat * (Cos(GrphHue) * K15 + Sin(GrphHue)**/ > - /* K16)) */ > - rgb_matrix[9] = dal_fixed31_32_mul(grph_cont, rgb_matrix[9]); > - > - /* COEF_3_3 = GrphCont * (LumaB + GrphSat * (Cos(GrphHue) * K17 +*/ > - /* Sin(GrphHue) * K18)) */ > - /* (Cos(GrphHue) * K17 + Sin(GrphHue) * K18)) */ > - rgb_matrix[10] = > - dal_fixed31_32_add( > - dal_fixed31_32_mul(cos_grph_hue, k17), > - dal_fixed31_32_mul(sin_grph_hue, k18)); > - /* GrphSat * (Cos(GrphHue) * K17 + Sin(GrphHue) * K18)) */ > - rgb_matrix[10] = dal_fixed31_32_mul(grph_sat, rgb_matrix[10]); > - /* (LumaB + GrphSat * (Cos(GrphHue) * K17 + Sin(GrphHue) * K18)) */ > - rgb_matrix[10] = dal_fixed31_32_add(luma_b, rgb_matrix[10]); > - /* GrphCont * (LumaB + GrphSat * (Cos(GrphHue) * K17 + Sin(GrphHue)**/ > - /* K18)) */ > - rgb_matrix[10] = dal_fixed31_32_mul(grph_cont, rgb_matrix[10]); > - > - /* COEF_3_4 = GrphBright */ > - rgb_matrix[11] = grph_bright; > -} > - > -static void calculate_rgb_limited_range_matrix_legacy( > - struct core_color *core_color, unsigned int sink_index, > - struct fixed31_32 *rgb_matrix) > -{ > - const struct fixed31_32 k1 = > - dal_fixed31_32_from_fraction(701000, 1000000); > - const struct fixed31_32 k2 = > - dal_fixed31_32_from_fraction(236568, 1000000); > - const struct fixed31_32 k3 = > - dal_fixed31_32_from_fraction(-587000, 1000000); > - const struct fixed31_32 k4 = > - dal_fixed31_32_from_fraction(464432, 1000000); > - const struct fixed31_32 k5 = > - dal_fixed31_32_from_fraction(-114000, 1000000); > - const struct fixed31_32 k6 = > - dal_fixed31_32_from_fraction(-701000, 1000000); > - const struct fixed31_32 k7 = > - dal_fixed31_32_from_fraction(-299000, 1000000); > - const struct fixed31_32 k8 = > - dal_fixed31_32_from_fraction(-292569, 1000000); > - const struct fixed31_32 k9 = > - dal_fixed31_32_from_fraction(413000, 1000000); > - const struct fixed31_32 k10 = > - dal_fixed31_32_from_fraction(-92482, 1000000); > - const struct fixed31_32 k11 = > - dal_fixed31_32_from_fraction(-114000, 1000000); > - const struct fixed31_32 k12 = > - dal_fixed31_32_from_fraction(385051, 1000000); > - const struct fixed31_32 k13 = > - dal_fixed31_32_from_fraction(-299000, 1000000); > - const struct fixed31_32 k14 = > - dal_fixed31_32_from_fraction(886000, 1000000); > - const struct fixed31_32 k15 = > - dal_fixed31_32_from_fraction(-587000, 1000000); > - const struct fixed31_32 k16 = > - dal_fixed31_32_from_fraction(-741914, 1000000); > - const struct fixed31_32 k17 = > - dal_fixed31_32_from_fraction(886000, 1000000); > - const struct fixed31_32 k18 = > - dal_fixed31_32_from_fraction(-144086, 1000000); > - > - const struct fixed31_32 luma_r = > - dal_fixed31_32_from_fraction(299, 1000); > - const struct fixed31_32 luma_g = > - dal_fixed31_32_from_fraction(587, 1000); > - const struct fixed31_32 luma_b = > - dal_fixed31_32_from_fraction(114, 1000); > - const struct fixed31_32 luma_scale = > - dal_fixed31_32_from_fraction(875855, 1000000); > - > - const struct fixed31_32 rgb_scale = > - dal_fixed31_32_from_fraction(85546875, 100000000); > - const struct fixed31_32 rgb_bias = > - dal_fixed31_32_from_fraction(625, 10000); > - > - struct fixed31_32 grph_cont; > - struct fixed31_32 grph_sat; > - struct fixed31_32 grph_bright; > - struct fixed31_32 sin_grph_hue; > - struct fixed31_32 cos_grph_hue; > - > - initialize_fix_point_color_values( > - core_color, sink_index, &grph_cont, &grph_sat, > - &grph_bright, &sin_grph_hue, &cos_grph_hue); > - > - /* COEF_1_1 = GrphCont * (LumaR + GrphSat * (Cos(GrphHue) * K1 +*/ > - /* Sin(GrphHue) * K2))*/ > - /* (Cos(GrphHue) * K1 + Sin(GrphHue) * K2)*/ > - rgb_matrix[0] = > - dal_fixed31_32_add( > - dal_fixed31_32_mul(cos_grph_hue, k1), > - dal_fixed31_32_mul(sin_grph_hue, k2)); > - /* GrphSat * (Cos(GrphHue) * K1 + Sin(GrphHue) * K2 */ > - rgb_matrix[0] = dal_fixed31_32_mul(grph_sat, rgb_matrix[0]); > - /* (LumaR + GrphSat * (Cos(GrphHue) * K1 + Sin(GrphHue) * K2))*/ > - rgb_matrix[0] = dal_fixed31_32_add(luma_r, rgb_matrix[0]); > - /* GrphCont * (LumaR + GrphSat * (Cos(GrphHue) * K1 + Sin(GrphHue)**/ > - /* K2))*/ > - rgb_matrix[0] = dal_fixed31_32_mul(grph_cont, rgb_matrix[0]); > - /* LumaScale * GrphCont * (LumaR + GrphSat * (Cos(GrphHue) * K1 + */ > - /* Sin(GrphHue) * K2))*/ > - rgb_matrix[0] = dal_fixed31_32_mul(luma_scale, rgb_matrix[0]); > - > - /* COEF_1_2 = GrphCont * (LumaG + GrphSat * (Cos(GrphHue) * K3 +*/ > - /* Sin(GrphHue) * K4))*/ > - /* (Cos(GrphHue) * K3 + Sin(GrphHue) * K4)*/ > - rgb_matrix[1] = > - dal_fixed31_32_add( > - dal_fixed31_32_mul(cos_grph_hue, k3), > - dal_fixed31_32_mul(sin_grph_hue, k4)); > - /* GrphSat * (Cos(GrphHue) * K3 + Sin(GrphHue) * K4)*/ > - rgb_matrix[1] = dal_fixed31_32_mul(grph_sat, rgb_matrix[1]); > - /* (LumaG + GrphSat * (Cos(GrphHue) * K3 + Sin(GrphHue) * K4))*/ > - rgb_matrix[1] = dal_fixed31_32_add(luma_g, rgb_matrix[1]); > - /* GrphCont * (LumaG + GrphSat * (Cos(GrphHue) * K3 + Sin(GrphHue)**/ > - /* K4))*/ > - rgb_matrix[1] = dal_fixed31_32_mul(grph_cont, rgb_matrix[1]); > - /* LumaScale * GrphCont * (LumaG + GrphSat *(Cos(GrphHue) * K3 + */ > - /* Sin(GrphHue) * K4))*/ > - rgb_matrix[1] = dal_fixed31_32_mul(luma_scale, rgb_matrix[1]); > - > - /* COEF_1_3 = GrphCont * (LumaB + GrphSat * (Cos(GrphHue) * K5 +*/ > - /* Sin(GrphHue) * K6))*/ > - /* (Cos(GrphHue) * K5 + Sin(GrphHue) * K6)*/ > - rgb_matrix[2] = > - dal_fixed31_32_add( > - dal_fixed31_32_mul(cos_grph_hue, k5), > - dal_fixed31_32_mul(sin_grph_hue, k6)); > - /* GrphSat * (Cos(GrphHue) * K5 + Sin(GrphHue) * K6)*/ > - rgb_matrix[2] = dal_fixed31_32_mul(grph_sat, rgb_matrix[2]); > - /* LumaB + GrphSat * (Cos(GrphHue) * K5 + Sin(GrphHue) * K6)*/ > - rgb_matrix[2] = dal_fixed31_32_add(luma_b, rgb_matrix[2]); > - /* GrphCont * (LumaB + GrphSat * (Cos(GrphHue) * K5 + Sin(GrphHue)**/ > - /* K6))*/ > - rgb_matrix[2] = dal_fixed31_32_mul(grph_cont, rgb_matrix[2]); > - /* LumaScale * GrphCont * (LumaB + GrphSat *(Cos(GrphHue) * K5 + */ > - /* Sin(GrphHue) * K6))*/ > - rgb_matrix[2] = dal_fixed31_32_mul(luma_scale, rgb_matrix[2]); > - > - /* COEF_1_4 = RGBBias + RGBScale * GrphBright*/ > - rgb_matrix[3] = dal_fixed31_32_add( > - rgb_bias, > - dal_fixed31_32_mul(rgb_scale, grph_bright)); > - > - /* COEF_2_1 = GrphCont * (LumaR + GrphSat * (Cos(GrphHue) * K7 +*/ > - /* Sin(GrphHue) * K8))*/ > - /* (Cos(GrphHue) * K7 + Sin(GrphHue) * K8)*/ > - rgb_matrix[4] = > - dal_fixed31_32_add( > - dal_fixed31_32_mul(cos_grph_hue, k7), > - dal_fixed31_32_mul(sin_grph_hue, k8)); > - /* GrphSat * (Cos(GrphHue) * K7 + Sin(GrphHue) * K8)*/ > - rgb_matrix[4] = dal_fixed31_32_mul(grph_sat, rgb_matrix[4]); > - /* (LumaR + GrphSat * (Cos(GrphHue) * K7 + Sin(GrphHue) * K8))*/ > - rgb_matrix[4] = dal_fixed31_32_add(luma_r, rgb_matrix[4]); > - /* GrphCont * (LumaR + GrphSat * (Cos(GrphHue) * K7 + Sin(GrphHue)**/ > - /* K8))*/ > - rgb_matrix[4] = dal_fixed31_32_mul(grph_cont, rgb_matrix[4]); > - /* LumaScale * GrphCont * (LumaR + GrphSat * (Cos(GrphHue) * K7 + */ > - /* Sin(GrphHue) * K8))*/ > - rgb_matrix[4] = dal_fixed31_32_mul(luma_scale, rgb_matrix[4]); > - > - /* COEF_2_2 = GrphCont * (LumaG + GrphSat * (Cos(GrphHue) * K9 +*/ > - /* Sin(GrphHue) * K10))*/ > - /* (Cos(GrphHue) * K9 + Sin(GrphHue) * K10))*/ > - rgb_matrix[5] = > - dal_fixed31_32_add( > - dal_fixed31_32_mul(cos_grph_hue, k9), > - dal_fixed31_32_mul(sin_grph_hue, k10)); > - /* GrphSat * (Cos(GrphHue) * K9 + Sin(GrphHue) * K10))*/ > - rgb_matrix[5] = dal_fixed31_32_mul(grph_sat, rgb_matrix[5]); > - /* (LumaG + GrphSat * (Cos(GrphHue) * K9 + Sin(GrphHue) * K10))*/ > - rgb_matrix[5] = dal_fixed31_32_add(luma_g, rgb_matrix[5]); > - /* GrphCont * (LumaG + GrphSat * (Cos(GrphHue) * K9 + Sin(GrphHue)**/ > - /* K10))*/ > - rgb_matrix[5] = dal_fixed31_32_mul(grph_cont, rgb_matrix[5]); > - /* LumaScale * GrphCont * (LumaG + GrphSat *(Cos(GrphHue) * K9 + */ > - /* Sin(GrphHue) * K10))*/ > - rgb_matrix[5] = dal_fixed31_32_mul(luma_scale, rgb_matrix[5]); > - > - /* COEF_2_3 = GrphCont * (LumaB + GrphSat * (Cos(GrphHue) * K11 +*/ > - /* Sin(GrphHue) * K12))*/ > - /* (Cos(GrphHue) * K11 + Sin(GrphHue) * K12))*/ > - rgb_matrix[6] = > - dal_fixed31_32_add( > - dal_fixed31_32_mul(cos_grph_hue, k11), > - dal_fixed31_32_mul(sin_grph_hue, k12)); > - /* GrphSat * (Cos(GrphHue) * K11 + Sin(GrphHue) * K12))*/ > - rgb_matrix[6] = dal_fixed31_32_mul(grph_sat, rgb_matrix[6]); > - /* (LumaB + GrphSat * (Cos(GrphHue) * K11 + Sin(GrphHue) * K12))*/ > - rgb_matrix[6] = dal_fixed31_32_add(luma_b, rgb_matrix[6]); > - /* GrphCont * (LumaB + GrphSat * (Cos(GrphHue) * K11 + Sin(GrphHue)**/ > - /* K12))*/ > - rgb_matrix[6] = dal_fixed31_32_mul(grph_cont, rgb_matrix[6]); > - /* LumaScale * GrphCont * (LumaB + GrphSat *(Cos(GrphHue) * K11 +*/ > - /* Sin(GrphHue) * K12)) */ > - rgb_matrix[6] = dal_fixed31_32_mul(luma_scale, rgb_matrix[6]); > - > - /* COEF_2_4 = RGBBias + RGBScale * GrphBright*/ > - rgb_matrix[7] = dal_fixed31_32_add( > - rgb_bias, > - dal_fixed31_32_mul(rgb_scale, grph_bright)); > - > - /* COEF_3_1 = GrphCont * (LumaR + GrphSat * (Cos(GrphHue) * K13 +*/ > - /* Sin(GrphHue) * K14))*/ > - /* (Cos(GrphHue) * K13 + Sin(GrphHue) * K14)) */ > - rgb_matrix[8] = > - dal_fixed31_32_add( > - dal_fixed31_32_mul(cos_grph_hue, k13), > - dal_fixed31_32_mul(sin_grph_hue, k14)); > - /* GrphSat * (Cos(GrphHue) * K13 + Sin(GrphHue) * K14)) */ > - rgb_matrix[8] = dal_fixed31_32_mul(grph_sat, rgb_matrix[8]); > - /* (LumaR + GrphSat * (Cos(GrphHue) * K13 + Sin(GrphHue) * K14)) */ > - rgb_matrix[8] = dal_fixed31_32_add(luma_r, rgb_matrix[8]); > - /* GrphCont * (LumaR + GrphSat * (Cos(GrphHue) * K13 + Sin(GrphHue)**/ > - /* K14)) */ > - rgb_matrix[8] = dal_fixed31_32_mul(grph_cont, rgb_matrix[8]); > - /* LumaScale * GrphCont * (LumaR + GrphSat * (Cos(GrphHue) * K13 +*/ > - /* Sin(GrphHue) * K14))*/ > - rgb_matrix[8] = dal_fixed31_32_mul(luma_scale, rgb_matrix[8]); > - > - /* COEF_3_2 = GrphCont * (LumaG + GrphSat * (Cos(GrphHue) * K15 +*/ > - /* Sin(GrphHue) * K16)) */ > - /* GrphSat * (Cos(GrphHue) * K15 + Sin(GrphHue) * K16) */ > - rgb_matrix[9] = > - dal_fixed31_32_add( > - dal_fixed31_32_mul(cos_grph_hue, k15), > - dal_fixed31_32_mul(sin_grph_hue, k16)); > - /* (LumaG + GrphSat * (Cos(GrphHue) * K15 + Sin(GrphHue) * K16)) */ > - rgb_matrix[9] = dal_fixed31_32_mul(grph_sat, rgb_matrix[9]); > - /* (LumaG + GrphSat * (Cos(GrphHue) * K15 + Sin(GrphHue) * K16)) */ > - rgb_matrix[9] = dal_fixed31_32_add(luma_g, rgb_matrix[9]); > - /* GrphCont * (LumaG + GrphSat * (Cos(GrphHue) * K15 + Sin(GrphHue)**/ > - /* K16)) */ > - rgb_matrix[9] = dal_fixed31_32_mul(grph_cont, rgb_matrix[9]); > - /* LumaScale * GrphCont * (LumaG + GrphSat *(Cos(GrphHue) * K15 + */ > - /* Sin(GrphHue) * K16))*/ > - rgb_matrix[9] = dal_fixed31_32_mul(luma_scale, rgb_matrix[9]); > - > - /* COEF_3_3 = GrphCont * (LumaB + GrphSat * (Cos(GrphHue) * K17 +*/ > - /* Sin(GrphHue) * K18)) */ > - /* (Cos(GrphHue) * K17 + Sin(GrphHue) * K18)) */ > - rgb_matrix[10] = > - dal_fixed31_32_add( > - dal_fixed31_32_mul(cos_grph_hue, k17), > - dal_fixed31_32_mul(sin_grph_hue, k18)); > - /* GrphSat * (Cos(GrphHue) * K17 + Sin(GrphHue) * K18)) */ > - rgb_matrix[10] = dal_fixed31_32_mul(grph_sat, rgb_matrix[10]); > - /* (LumaB + GrphSat * (Cos(GrphHue) * K17 + Sin(GrphHue) * K18)) */ > - rgb_matrix[10] = dal_fixed31_32_add(luma_b, rgb_matrix[10]); > - /* GrphCont * (LumaB + GrphSat * (Cos(GrphHue) * K17 + Sin(GrphHue)**/ > - /* K18)) */ > - rgb_matrix[10] = dal_fixed31_32_mul(grph_cont, rgb_matrix[10]); > - /* LumaScale * GrphCont * (LumaB + GrphSat *(Cos(GrphHue) * */ > - /* K17 + Sin(GrphHue) * K18))*/ > - rgb_matrix[10] = dal_fixed31_32_mul(luma_scale, rgb_matrix[10]); > - > - /* COEF_3_4 = RGBBias + RGBScale * GrphBright */ > - rgb_matrix[11] = dal_fixed31_32_add( > - rgb_bias, > - dal_fixed31_32_mul(rgb_scale, grph_bright)); > -} > - > -static void calculate_yuv_matrix(struct core_color *core_color, > - unsigned int sink_index, > - enum dc_color_space color_space, > - struct fixed31_32 *yuv_matrix) > -{ > - struct fixed31_32 ideal[12]; > - uint32_t i = 0; > - > - if ((color_space == COLOR_SPACE_YPBPR601) || > - (color_space == COLOR_SPACE_YCBCR601) || > - (color_space == COLOR_SPACE_YCBCR601_LIMITED)) { > - static const int32_t matrix_[] = { > - 25578516, 50216016, 9752344, 6250000, > - -14764391, -28985609, 43750000, 50000000, > - 43750000, -36635164, -7114836, 50000000 > - }; > - do { > - ideal[i] = dal_fixed31_32_from_fraction( > - matrix_[i], > - 100000000); > - ++i; > - } while (i != ARRAY_SIZE(matrix_)); > - } else { > - static const int32_t matrix_[] = { > - 18187266, 61183125, 6176484, 6250000, > - -10025059, -33724941, 43750000, 50000000, > - 43750000, -39738379, -4011621, 50000000 > - }; > - do { > - ideal[i] = dal_fixed31_32_from_fraction( > - matrix_[i], > - 100000000); > - ++i; > - } while (i != ARRAY_SIZE(matrix_)); > - } > - > - struct fixed31_32 grph_cont; > - struct fixed31_32 grph_sat; > - struct fixed31_32 grph_bright; > - struct fixed31_32 sin_grph_hue; > - struct fixed31_32 cos_grph_hue; > - > - initialize_fix_point_color_values( > - core_color, sink_index, &grph_cont, &grph_sat, > - &grph_bright, &sin_grph_hue, &cos_grph_hue); > - > - const struct fixed31_32 multiplier = > - dal_fixed31_32_mul(grph_cont, grph_sat); > - > - yuv_matrix[0] = dal_fixed31_32_mul(ideal[0], grph_cont); > - > - yuv_matrix[1] = dal_fixed31_32_mul(ideal[1], grph_cont); > - > - yuv_matrix[2] = dal_fixed31_32_mul(ideal[2], grph_cont); > - > - yuv_matrix[4] = dal_fixed31_32_mul( > - multiplier, > - dal_fixed31_32_add( > - dal_fixed31_32_mul( > - ideal[4], > - cos_grph_hue), > - dal_fixed31_32_mul( > - ideal[8], > - sin_grph_hue))); > - > - yuv_matrix[5] = dal_fixed31_32_mul( > - multiplier, > - dal_fixed31_32_add( > - dal_fixed31_32_mul( > - ideal[5], > - cos_grph_hue), > - dal_fixed31_32_mul( > - ideal[9], > - sin_grph_hue))); > - > - yuv_matrix[6] = dal_fixed31_32_mul( > - multiplier, > - dal_fixed31_32_add( > - dal_fixed31_32_mul( > - ideal[6], > - cos_grph_hue), > - dal_fixed31_32_mul( > - ideal[10], > - sin_grph_hue))); > - > - yuv_matrix[7] = ideal[7]; > - > - yuv_matrix[8] = dal_fixed31_32_mul( > - multiplier, > - dal_fixed31_32_sub( > - dal_fixed31_32_mul( > - ideal[8], > - cos_grph_hue), > - dal_fixed31_32_mul( > - ideal[4], > - sin_grph_hue))); > - > - yuv_matrix[9] = dal_fixed31_32_mul( > - multiplier, > - dal_fixed31_32_sub( > - dal_fixed31_32_mul( > - ideal[9], > - cos_grph_hue), > - dal_fixed31_32_mul( > - ideal[5], > - sin_grph_hue))); > - > - yuv_matrix[10] = dal_fixed31_32_mul( > - multiplier, > - dal_fixed31_32_sub( > - dal_fixed31_32_mul( > - ideal[10], > - cos_grph_hue), > - dal_fixed31_32_mul( > - ideal[6], > - sin_grph_hue))); > - > - yuv_matrix[11] = ideal[11]; > - > - if ((color_space == COLOR_SPACE_YCBCR601_LIMITED) || > - (color_space == COLOR_SPACE_YCBCR709_LIMITED)) { > - yuv_matrix[3] = dal_fixed31_32_add(ideal[3], grph_bright); > - } else { > - yuv_matrix[3] = dal_fixed31_32_add( > - ideal[3], > - dal_fixed31_32_mul( > - grph_bright, > - dal_fixed31_32_from_fraction(86, 100))); > - } > -} > - > -static void calculate_csc_matrix(struct core_color *core_color, > - unsigned int sink_index, > - enum dc_color_space color_space, > - uint16_t *csc_matrix) > -{ > - struct fixed31_32 fixed_csc_matrix[12]; > - switch (color_space) { > - case COLOR_SPACE_SRGB: > - calculate_rgb_matrix_legacy > - (core_color, sink_index, fixed_csc_matrix); > - convert_float_matrix_legacy > - (csc_matrix, fixed_csc_matrix, 12); > - break; > - case COLOR_SPACE_SRGB_LIMITED: > - calculate_rgb_limited_range_matrix_legacy( > - core_color, sink_index, fixed_csc_matrix); > - convert_float_matrix_legacy(csc_matrix, fixed_csc_matrix, 12); > - break; > - case COLOR_SPACE_YCBCR601: > - case COLOR_SPACE_YCBCR709: > - case COLOR_SPACE_YCBCR601_LIMITED: > - case COLOR_SPACE_YCBCR709_LIMITED: > - case COLOR_SPACE_YPBPR601: > - case COLOR_SPACE_YPBPR709: > - calculate_yuv_matrix(core_color, sink_index, color_space, > - fixed_csc_matrix); > - convert_float_matrix(csc_matrix, fixed_csc_matrix, 12); > - break; > - default: > - calculate_rgb_matrix_legacy > - (core_color, sink_index, fixed_csc_matrix); > - convert_float_matrix_legacy > - (csc_matrix, fixed_csc_matrix, 12); > - break; > - } > -} > - > -static struct dc_surface *dc_stream_to_surface_from_pipe_ctx( > - struct core_color *core_color, > - const struct dc_stream *stream) > -{ > - int i; > - struct core_dc *core_dc = DC_TO_CORE(core_color->dc); > - struct core_stream *core_stream = DC_STREAM_TO_CORE(stream); > - struct dc_surface *out_surface = NULL; > - > - for (i = 0; i < MAX_PIPES; i++) { > - if (core_dc->current_context->res_ctx.pipe_ctx[i].stream > - == core_stream) { > - out_surface = &core_dc->current_context->res_ctx. > - pipe_ctx[i].surface->public; > - break; > - } > - } > - return out_surface; > -} > - > -static enum predefined_gamut_type color_space_to_predefined_gamut_types(enum > - color_color_space color_space) > -{ > - switch (color_space) { > - case color_space_bt709: > - case color_space_xv_ycc_bt709: > - return gamut_type_bt709; > - case color_space_bt601: > - case color_space_xv_ycc_bt601: > - return gamut_type_bt601; > - case color_space_adobe: > - return gamut_type_adobe_rgb; > - case color_space_srgb: > - case color_space_sc_rgb_ms_ref: > - return gamut_type_srgb; > - case color_space_bt2020: > - return gamut_type_bt2020; > - case color_space_dci_p3: /* TODO */ > - default: > - return gamut_type_unknown; > - } > -} > - > -static enum predefined_white_point_type white_point_to_predefined_white_point > - (enum color_white_point_type white_point) > -{ > - switch (white_point) { > - case color_white_point_type_5000k_horizon: > - return white_point_type_5000k_horizon; > - case color_white_point_type_6500k_noon: > - return white_point_type_6500k_noon; > - case color_white_point_type_7500k_north_sky: > - return white_point_type_7500k_north_sky; > - case color_white_point_type_9300k: > - return white_point_type_9300k; > - default: > - return white_point_type_unknown; > - } > -} > - > -static bool update_color_gamut_data(struct color_gamut_data *input_data, > - struct color_gamut_data *output_data) > -{ > - bool output_custom_cs = false; > - bool output_custom_wp = false; > - > - if (input_data == NULL || output_data == NULL) > - return false; > - > - if (input_data->color_space == color_space_custom_coordinates) { > - output_data->color_space = input_data->color_space; > - output_data->gamut.redX = input_data->gamut.redX; > - output_data->gamut.redY = input_data->gamut.redY; > - output_data->gamut.greenX = input_data->gamut.greenX; > - output_data->gamut.greenY = input_data->gamut.greenY; > - output_data->gamut.blueX = input_data->gamut.blueX; > - output_data->gamut.blueY = input_data->gamut.blueY; > - } else { > - struct gamut_space_coordinates gamut_coord; > - enum predefined_gamut_type gamut_type = > - color_space_to_predefined_gamut_types > - (input_data->color_space); > - > - /* fall back to original color space if unknown */ > - if (gamut_type == gamut_type_unknown) { > - if (output_data->color_space == > - color_space_custom_coordinates) { > - output_custom_cs = true; > - } else { > - gamut_type = > - color_space_to_predefined_gamut_types > - (output_data->color_space); > - /* fall back to sRGB if both unknown*/ > - if (gamut_type == gamut_type_unknown) { > - output_data->color_space = > - color_space_srgb; > - gamut_type = gamut_type_srgb; > - } > - } > - } else { > - output_data->color_space = input_data->color_space; > - } > - > - if (!output_custom_cs) { > - mod_color_find_predefined_gamut(&gamut_coord, > - gamut_type); > - output_data->gamut.redX = gamut_coord.redX; > - output_data->gamut.redY = gamut_coord.redY; > - output_data->gamut.greenX = gamut_coord.greenX; > - output_data->gamut.greenY = gamut_coord.greenY; > - output_data->gamut.blueX = gamut_coord.blueX; > - output_data->gamut.blueY = gamut_coord.blueY; > - } > - } > - > - if (input_data->white_point == color_space_custom_coordinates) { > - output_data->white_point = input_data->white_point; > - output_data->gamut.whiteX = input_data->gamut.whiteX; > - output_data->gamut.whiteY = input_data->gamut.whiteY; > - } else { > - struct white_point_coodinates white_point_coord; > - enum predefined_white_point_type white_type = > - white_point_to_predefined_white_point > - (input_data->white_point); > - > - /* fall back to original white point if not found */ > - if (white_type == white_point_type_unknown) { > - if (output_data->white_point == > - color_white_point_type_custom_coordinates) { > - output_custom_wp = true; > - } else { > - white_type = > - white_point_to_predefined_white_point > - (output_data->white_point); > - /* fall back to 6500 if both unknown*/ > - if (white_type == white_point_type_unknown) { > - output_data->white_point = > - color_white_point_type_6500k_noon; > - white_type = > - white_point_type_6500k_noon; > - } > - } > - } else { > - output_data->white_point = input_data->white_point; > - } > - > - if (!output_custom_wp) { > - mod_color_find_predefined_white_point( > - &white_point_coord, white_type); > - output_data->gamut.whiteX = white_point_coord.whiteX; > - output_data->gamut.whiteY = white_point_coord.whiteY; > - } > - } > - return true; > -} > - > -void initialize_color_state(struct core_color *core_color, int index) > -{ > - core_color->state[index].user_enable_color_temperature = true; > - > - core_color->state[index].custom_color_temperature = 6500; > - > - core_color->state[index].contrast.current = 100; > - core_color->state[index].contrast.min = 0; > - core_color->state[index].contrast.max = 200; > - > - core_color->state[index].saturation.current = 100; > - core_color->state[index].saturation.min = 0; > - core_color->state[index].saturation.max = 200; > - > - core_color->state[index].brightness.current = 0; > - core_color->state[index].brightness.min = -100; > - core_color->state[index].brightness.max = 100; > - > - core_color->state[index].hue.current = 0; > - core_color->state[index].hue.min = -30; > - core_color->state[index].hue.max = 30; > - > - core_color->state[index].gamma = NULL; > - > - core_color->state[index].preferred_quantization_range = > - QUANTIZATION_RANGE_FULL; > - > - core_color->state[index].source_gamut.color_space = > - color_space_srgb; > - core_color->state[index].source_gamut.white_point = > - color_white_point_type_6500k_noon; > - core_color->state[index].source_gamut.gamut.blueX = 1500; > - core_color->state[index].source_gamut.gamut.blueY = 600; > - core_color->state[index].source_gamut.gamut.greenX = 3000; > - core_color->state[index].source_gamut.gamut.greenY = 6000; > - core_color->state[index].source_gamut.gamut.redX = 6400; > - core_color->state[index].source_gamut.gamut.redY = 3300; > - core_color->state[index].source_gamut.gamut.whiteX = 3127; > - core_color->state[index].source_gamut.gamut.whiteY = 3290; > - > - core_color->state[index].destination_gamut.color_space = > - color_space_srgb; > - core_color->state[index].destination_gamut.white_point = > - color_white_point_type_6500k_noon; > - core_color->state[index].destination_gamut.gamut.blueX = 1500; > - core_color->state[index].destination_gamut.gamut.blueY = 600; > - core_color->state[index].destination_gamut.gamut.greenX = 3000; > - core_color->state[index].destination_gamut.gamut.greenY = 6000; > - core_color->state[index].destination_gamut.gamut.redX = 6400; > - core_color->state[index].destination_gamut.gamut.redY = 3300; > - core_color->state[index].destination_gamut.gamut.whiteX = 3127; > - core_color->state[index].destination_gamut.gamut.whiteY = 3290; > - > - core_color->state[index].input_transfer_function = > - transfer_func_srgb; > - core_color->state[index].output_transfer_function = > - transfer_func_srgb; > -} > - > -struct mod_color *mod_color_create(struct dc *dc) > -{ > - int i = 0; > - struct core_color *core_color = > - dm_alloc(sizeof(struct core_color)); > - struct core_dc *core_dc = DC_TO_CORE(dc); > - struct persistent_data_flag flag; > - > - if (core_color == NULL) > - goto fail_alloc_context; > - > - core_color->caps = dm_alloc(sizeof(struct sink_caps) * > - MOD_COLOR_MAX_CONCURRENT_SINKS); > - > - if (core_color->caps == NULL) > - goto fail_alloc_caps; > - > - for (i = 0; i < MOD_COLOR_MAX_CONCURRENT_SINKS; i++) > - core_color->caps[i].sink = NULL; > - > - core_color->state = dm_alloc(sizeof(struct color_state) * > - MOD_COLOR_MAX_CONCURRENT_SINKS); > - > - /*hardcoded to sRGB with 6500 color temperature*/ > - for (i = 0; i < MOD_COLOR_MAX_CONCURRENT_SINKS; i++) { > - initialize_color_state(core_color, i); > - } > - > - if (core_color->state == NULL) > - goto fail_alloc_state; > - > - core_color->edid_caps = dm_alloc(sizeof(struct color_edid_caps) * > - MOD_COLOR_MAX_CONCURRENT_SINKS); > - > - if (core_color->edid_caps == NULL) > - goto fail_alloc_edid_caps; > - > - core_color->num_sinks = 0; > - > - if (dc == NULL) > - goto fail_construct; > - > - core_color->dc = dc; > - > - if (!check_dc_support(dc)) > - goto fail_construct; > - > - /* Create initial module folder in registry for color adjustment */ > - flag.save_per_edid = true; > - flag.save_per_link = false; > - > - dm_write_persistent_data(core_dc->ctx, NULL, COLOR_REGISTRY_NAME, NULL, > - NULL, 0, &flag); > - > - return &core_color->public; > - > -fail_construct: > - dm_free(core_color->edid_caps); > - > -fail_alloc_edid_caps: > - dm_free(core_color->state); > - > -fail_alloc_state: > - dm_free(core_color->caps); > - > -fail_alloc_caps: > - dm_free(core_color); > - > -fail_alloc_context: > - return NULL; > -} > - > -void mod_color_destroy(struct mod_color *mod_color) > -{ > - if (mod_color != NULL) { > - int i; > - struct core_color *core_color = > - MOD_COLOR_TO_CORE(mod_color); > - > - dm_free(core_color->edid_caps); > - > - for (i = 0; i < core_color->num_sinks; i++) > - if (core_color->state[i].gamma) > - dc_gamma_release(&core_color->state[i].gamma); > - > - dm_free(core_color->state); > - > - for (i = 0; i < core_color->num_sinks; i++) > - dc_sink_release(core_color->caps[i].sink); > - > - dm_free(core_color->caps); > - > - dm_free(core_color); > - } > -} > - > -bool mod_color_add_sink(struct mod_color *mod_color, const struct dc_sink *sink, > - struct color_edid_caps *edid_caps) > -{ > - struct core_color *core_color = MOD_COLOR_TO_CORE(mod_color); > - struct core_dc *core_dc = DC_TO_CORE(core_color->dc); > - bool persistent_color_temp_enable; > - int persistent_custom_color_temp = 0; > - struct color_space_coordinates persistent_source_gamut; > - struct color_space_coordinates persistent_destination_gamut; > - int persistent_brightness; > - int persistent_contrast; > - int persistent_hue; > - int persistent_saturation; > - enum dc_quantization_range persistent_quantization_range; > - struct persistent_data_flag flag; > - > - if (core_color->num_sinks < MOD_COLOR_MAX_CONCURRENT_SINKS) { > - dc_sink_retain(sink); > - core_color->caps[core_color->num_sinks].sink = sink; > - > - initialize_color_state(core_color, core_color->num_sinks); > - > - core_color->edid_caps[core_color->num_sinks].colorimetry_caps = > - edid_caps->colorimetry_caps; > - core_color->edid_caps[core_color->num_sinks].hdr_caps = > - edid_caps->hdr_caps; > - > - /* get persistent data from registry */ > - flag.save_per_edid = true; > - flag.save_per_link = false; > - > - if (dm_read_persistent_data(core_dc->ctx, sink, > - COLOR_REGISTRY_NAME, > - "enablecolortempadj", > - &persistent_color_temp_enable, > - sizeof(bool), &flag)) > - core_color->state[core_color->num_sinks]. > - user_enable_color_temperature = > - persistent_color_temp_enable; > - > - if (dm_read_persistent_data(core_dc->ctx, sink, > - COLOR_REGISTRY_NAME, > - "customcolortemp", > - &persistent_custom_color_temp, > - sizeof(int), &flag)) > - core_color->state[core_color->num_sinks]. > - custom_color_temperature > - = persistent_custom_color_temp; > - > - if (dm_read_persistent_data(core_dc->ctx, sink, > - COLOR_REGISTRY_NAME, > - "sourcegamut", > - &persistent_source_gamut, > - sizeof(struct color_space_coordinates), > - &flag)) { > - memcpy(&core_color->state[core_color->num_sinks]. > - source_gamut.gamut, &persistent_source_gamut, > - sizeof(struct color_space_coordinates)); > - } > - > - if (dm_read_persistent_data(core_dc->ctx, sink, COLOR_REGISTRY_NAME, > - "destgamut", > - &persistent_destination_gamut, > - sizeof(struct color_space_coordinates), > - &flag)) { > - memcpy(&core_color->state[core_color->num_sinks]. > - destination_gamut.gamut, > - &persistent_destination_gamut, > - sizeof(struct color_space_coordinates)); > - } > - > - if (dm_read_persistent_data(core_dc->ctx, sink, COLOR_REGISTRY_NAME, > - "brightness", > - &persistent_brightness, > - sizeof(int), &flag)) > - core_color->state[core_color->num_sinks]. > - brightness.current = persistent_brightness; > - > - if (dm_read_persistent_data(core_dc->ctx, sink, COLOR_REGISTRY_NAME, > - "contrast", > - &persistent_contrast, > - sizeof(int), &flag)) > - core_color->state[core_color->num_sinks]. > - contrast.current = persistent_contrast; > - > - if (dm_read_persistent_data(core_dc->ctx, sink, COLOR_REGISTRY_NAME, > - "hue", > - &persistent_hue, > - sizeof(int), &flag)) > - core_color->state[core_color->num_sinks]. > - hue.current = persistent_hue; > - > - if (dm_read_persistent_data(core_dc->ctx, sink, COLOR_REGISTRY_NAME, > - "saturation", > - &persistent_saturation, > - sizeof(int), &flag)) > - core_color->state[core_color->num_sinks]. > - saturation.current = persistent_saturation; > - > - if (dm_read_persistent_data(core_dc->ctx, sink, > - COLOR_REGISTRY_NAME, > - "preferred_quantization_range", > - &persistent_quantization_range, > - sizeof(int), &flag)) > - core_color->state[core_color->num_sinks]. > - preferred_quantization_range = > - persistent_quantization_range; > - > - core_color->num_sinks++; > - return true; > - } > - return false; > -} > - > -bool mod_color_remove_sink(struct mod_color *mod_color, > - const struct dc_sink *sink) > -{ > - int i = 0, j = 0; > - struct core_color *core_color = MOD_COLOR_TO_CORE(mod_color); > - > - for (i = 0; i < core_color->num_sinks; i++) { > - if (core_color->caps[i].sink == sink) { > - if (core_color->state[i].gamma) { > - dc_gamma_release(&core_color->state[i].gamma); > - } > - memset(&core_color->state[i], 0, > - sizeof(struct color_state)); > - memset(&core_color->edid_caps[i], 0, > - sizeof(struct color_edid_caps)); > - > - /* To remove this sink, shift everything after down */ > - for (j = i; j < core_color->num_sinks - 1; j++) { > - core_color->caps[j].sink = > - core_color->caps[j + 1].sink; > - > - memcpy(&core_color->state[j], > - &core_color->state[j + 1], > - sizeof(struct color_state)); > - > - memcpy(&core_color->edid_caps[j], > - &core_color->edid_caps[j + 1], > - sizeof(struct color_edid_caps)); > - } > - > - memset(&core_color->state[core_color->num_sinks - 1], 0, > - sizeof(struct color_state)); > - memset(&core_color->edid_caps[core_color->num_sinks - 1], 0, > - sizeof(struct color_edid_caps)); > - > - core_color->num_sinks--; > - > - dc_sink_release(sink); > - > - return true; > - } > - } > - > - return false; > -} > - > -bool mod_color_update_gamut_to_stream(struct mod_color *mod_color, > - const struct dc_stream **streams, int num_streams) > -{ > - struct core_color *core_color = MOD_COLOR_TO_CORE(mod_color); > - struct core_dc *core_dc = DC_TO_CORE(core_color->dc); > - struct persistent_data_flag flag; > - struct gamut_src_dst_matrix *matrix = > - dm_alloc(sizeof(struct gamut_src_dst_matrix)); > - > - unsigned int stream_index, j; > - int sink_index; > - > - for (stream_index = 0; stream_index < num_streams; stream_index++) { > - sink_index = sink_index_from_sink(core_color, > - streams[stream_index]->sink); > - if (sink_index == -1) > - continue; > - > - /* Write persistent data in registry*/ > - flag.save_per_edid = true; > - flag.save_per_link = false; > - > - dm_write_persistent_data(core_dc->ctx, > - streams[stream_index]->sink, > - COLOR_REGISTRY_NAME, > - "sourcegamut", > - &core_color->state[sink_index]. > - source_gamut.gamut, > - sizeof(struct color_space_coordinates), > - &flag); > - > - dm_write_persistent_data(core_dc->ctx, > - streams[stream_index]->sink, > - COLOR_REGISTRY_NAME, > - "destgamut", > - &core_color->state[sink_index]. > - destination_gamut.gamut, > - sizeof(struct color_space_coordinates), > - &flag); > - > - if (!build_gamut_remap_matrix > - (core_color->state[sink_index].source_gamut.gamut, > - matrix->rgbCoeffSrc, > - matrix->whiteCoeffSrc)) > - goto function_fail; > - > - if (!build_gamut_remap_matrix > - (core_color->state[sink_index]. > - destination_gamut.gamut, > - matrix->rgbCoeffDst, matrix->whiteCoeffDst)) > - goto function_fail; > - > - struct fixed31_32 gamut_result[12]; > - struct fixed31_32 temp_matrix[9]; > - > - if (!gamut_to_color_matrix( > - matrix->rgbCoeffDst, > - matrix->whiteCoeffDst, > - matrix->rgbCoeffSrc, > - matrix->whiteCoeffSrc, > - true, > - temp_matrix)) > - goto function_fail; > - > - gamut_result[0] = temp_matrix[0]; > - gamut_result[1] = temp_matrix[1]; > - gamut_result[2] = temp_matrix[2]; > - gamut_result[3] = matrix->whiteCoeffSrc[0]; > - gamut_result[4] = temp_matrix[3]; > - gamut_result[5] = temp_matrix[4]; > - gamut_result[6] = temp_matrix[5]; > - gamut_result[7] = matrix->whiteCoeffSrc[1]; > - gamut_result[8] = temp_matrix[6]; > - gamut_result[9] = temp_matrix[7]; > - gamut_result[10] = temp_matrix[8]; > - gamut_result[11] = matrix->whiteCoeffSrc[2]; > - > - struct core_stream *core_stream = > - DC_STREAM_TO_CORE > - (streams[stream_index]); > - > - core_stream->public.gamut_remap_matrix.enable_remap = true; > - > - for (j = 0; j < 12; j++) > - core_stream->public. > - gamut_remap_matrix.matrix[j] = > - gamut_result[j]; > - } > - > - dm_free(matrix); > - core_color->dc->stream_funcs.set_gamut_remap > - (core_color->dc, streams, num_streams); > - > - return true; > - > -function_fail: > - dm_free(matrix); > - return false; > -} > - > -bool mod_color_adjust_source_gamut(struct mod_color *mod_color, > - const struct dc_stream **streams, int num_streams, > - struct color_gamut_data *input_gamut_data) > -{ > - struct core_color *core_color = MOD_COLOR_TO_CORE(mod_color); > - > - unsigned int stream_index; > - int sink_index; > - > - for (stream_index = 0; stream_index < num_streams; stream_index++) { > - sink_index = sink_index_from_sink(core_color, > - streams[stream_index]->sink); > - if (sink_index == -1) > - continue; > - > - update_color_gamut_data(input_gamut_data, > - &core_color->state[sink_index].source_gamut); > - } > - > - if (!mod_color_update_gamut_info(mod_color, streams, num_streams)) > - return false; > - > - return true; > -} > - > -bool mod_color_adjust_source_gamut_and_tf(struct mod_color *mod_color, > - const struct dc_stream **streams, int num_streams, > - struct color_gamut_data *input_gamut_data, > - enum color_transfer_func input_transfer_func) > -{ > - struct core_color *core_color = MOD_COLOR_TO_CORE(mod_color); > - > - unsigned int stream_index; > - int sink_index; > - > - for (stream_index = 0; stream_index < num_streams; stream_index++) { > - sink_index = sink_index_from_sink(core_color, > - streams[stream_index]->sink); > - if (sink_index == -1) > - continue; > - update_color_gamut_data(input_gamut_data, > - &core_color->state[sink_index].source_gamut); > - core_color->state[sink_index].input_transfer_function = > - input_transfer_func; > - } > - > - if (!mod_color_update_gamut_info(mod_color, streams, num_streams)) > - return false; > - > - return true; > -} > - > -bool mod_color_adjust_destination_gamut(struct mod_color *mod_color, > - const struct dc_stream **streams, int num_streams, > - struct color_gamut_data *input_gamut_data) > -{ > - struct core_color *core_color = MOD_COLOR_TO_CORE(mod_color); > - > - unsigned int stream_index; > - int sink_index; > - > - for (stream_index = 0; stream_index < num_streams; stream_index++) { > - sink_index = sink_index_from_sink(core_color, > - streams[stream_index]->sink); > - if (sink_index == -1) > - continue; > - > - update_color_gamut_data(input_gamut_data, > - &core_color->state[sink_index].destination_gamut); > - } > - > - if (!mod_color_update_gamut_to_stream(mod_color, streams, num_streams)) > - return false; > - > - return true; > -} > - > -bool mod_color_set_white_point(struct mod_color *mod_color, > - const struct dc_stream **streams, int num_streams, > - struct white_point_coodinates *white_point) > -{ > - struct core_color *core_color = MOD_COLOR_TO_CORE(mod_color); > - > - unsigned int stream_index; > - int sink_index; > - > - for (stream_index = 0; stream_index < num_streams; > - stream_index++) { > - sink_index = sink_index_from_sink(core_color, > - streams[stream_index]->sink); > - if (sink_index == -1) > - continue; > - core_color->state[sink_index].source_gamut.gamut.whiteX = > - white_point->whiteX; > - core_color->state[sink_index].source_gamut.gamut.whiteY = > - white_point->whiteY; > - } > - > - if (!mod_color_update_gamut_to_stream(mod_color, streams, num_streams)) > - return false; > - > - return true; > -} > - > - > -bool mod_color_set_mastering_info(struct mod_color *mod_color, > - const struct dc_stream **streams, int num_streams, > - const struct dc_hdr_static_metadata *mastering_info) > -{ > - struct core_color *core_color = MOD_COLOR_TO_CORE(mod_color); > - unsigned int stream_index; > - int sink_index; > - > - for (stream_index = 0; stream_index < num_streams; stream_index++) { > - sink_index = sink_index_from_sink(core_color, > - streams[stream_index]->sink); > - if (sink_index == -1) > - continue; > - memcpy(&core_color->state[sink_index].mastering_info, > - mastering_info, > - sizeof(struct dc_hdr_static_metadata)); > - } > - return true; > -} > - > -bool mod_color_get_mastering_info(struct mod_color *mod_color, > - const struct dc_sink *sink, > - struct dc_hdr_static_metadata *mastering_info) > -{ > - struct core_color *core_color = > - MOD_COLOR_TO_CORE(mod_color); > - > - int sink_index = sink_index_from_sink(core_color, sink); > - > - if (sink_index == -1) > - return false; > - > - memcpy(mastering_info, &core_color->state[sink_index].mastering_info, > - sizeof(struct dc_hdr_static_metadata)); > - > - return true; > -} > - > -bool mod_color_set_user_enable(struct mod_color *mod_color, > - const struct dc_stream **streams, int num_streams, > - bool user_enable) > -{ > - struct core_color *core_color = > - MOD_COLOR_TO_CORE(mod_color); > - struct core_dc *core_dc = DC_TO_CORE(core_color->dc); > - struct persistent_data_flag flag; > - unsigned int stream_index; > - int sink_index; > - > - for (stream_index = 0; stream_index < num_streams; stream_index++) { > - sink_index = sink_index_from_sink(core_color, > - streams[stream_index]->sink); > - if (sink_index == -1) > - continue; > - core_color->state[sink_index].user_enable_color_temperature > - = user_enable; > - > - /* Write persistent data in registry*/ > - flag.save_per_edid = true; > - flag.save_per_link = false; > - > - dm_write_persistent_data(core_dc->ctx, > - streams[stream_index]->sink, > - COLOR_REGISTRY_NAME, > - "enablecolortempadj", > - &user_enable, > - sizeof(bool), > - &flag); > - } > - return true; > -} > - > -bool mod_color_get_user_enable(struct mod_color *mod_color, > - const struct dc_sink *sink, > - bool *user_enable) > -{ > - struct core_color *core_color = > - MOD_COLOR_TO_CORE(mod_color); > - > - int sink_index = sink_index_from_sink(core_color, sink); > - > - if (sink_index == -1) > - return false; > - > - *user_enable = core_color->state[sink_index]. > - user_enable_color_temperature; > - > - return true; > -} > - > -bool mod_color_get_custom_color_temperature(struct mod_color *mod_color, > - const struct dc_sink *sink, > - int *color_temperature) > -{ > - struct core_color *core_color = > - MOD_COLOR_TO_CORE(mod_color); > - > - int sink_index = sink_index_from_sink(core_color, sink); > - > - if (sink_index == -1) > - return false; > - > - *color_temperature = core_color->state[sink_index]. > - custom_color_temperature; > - > - return true; > -} > - > -bool mod_color_set_custom_color_temperature(struct mod_color *mod_color, > - const struct dc_stream **streams, int num_streams, > - int color_temperature) > -{ > - struct core_color *core_color = > - MOD_COLOR_TO_CORE(mod_color); > - struct core_dc *core_dc = DC_TO_CORE(core_color->dc); > - struct persistent_data_flag flag; > - unsigned int stream_index; > - int sink_index; > - > - for (stream_index = 0; stream_index < num_streams; stream_index++) { > - sink_index = sink_index_from_sink(core_color, > - streams[stream_index]->sink); > - if (sink_index == -1) > - continue; > - core_color->state[sink_index].custom_color_temperature > - = color_temperature; > - > - /* Write persistent data in registry*/ > - flag.save_per_edid = true; > - flag.save_per_link = false; > - > - dm_write_persistent_data(core_dc->ctx, > - streams[stream_index]->sink, > - COLOR_REGISTRY_NAME, > - "customcolortemp", > - &color_temperature, > - sizeof(int), > - &flag); > - } > - return true; > -} > - > -bool mod_color_get_color_saturation(struct mod_color *mod_color, > - const struct dc_sink *sink, > - struct color_range *color_saturation) > -{ > - struct core_color *core_color = > - MOD_COLOR_TO_CORE(mod_color); > - > - int sink_index = sink_index_from_sink(core_color, sink); > - > - if (sink_index == -1) > - return false; > - > - *color_saturation = core_color->state[sink_index].saturation; > - > - return true; > -} > - > -bool mod_color_get_color_contrast(struct mod_color *mod_color, > - const struct dc_sink *sink, > - struct color_range *color_contrast) > -{ > - struct core_color *core_color = > - MOD_COLOR_TO_CORE(mod_color); > - > - int sink_index = sink_index_from_sink(core_color, sink); > - > - if (sink_index == -1) > - return false; > - > - *color_contrast = core_color->state[sink_index].contrast; > - > - return true; > -} > - > -bool mod_color_get_color_brightness(struct mod_color *mod_color, > - const struct dc_sink *sink, > - struct color_range *color_brightness) > -{ > - struct core_color *core_color = > - MOD_COLOR_TO_CORE(mod_color); > - > - int sink_index = sink_index_from_sink(core_color, sink); > - > - if (sink_index == -1) > - return false; > - > - *color_brightness = core_color->state[sink_index].brightness; > - > - return true; > -} > - > -bool mod_color_get_color_hue(struct mod_color *mod_color, > - const struct dc_sink *sink, > - struct color_range *color_hue) > -{ > - struct core_color *core_color = > - MOD_COLOR_TO_CORE(mod_color); > - > - int sink_index = sink_index_from_sink(core_color, sink); > - > - if (sink_index == -1) > - return false; > - > - *color_hue = core_color->state[sink_index].hue; > - > - return true; > -} > - > -bool mod_color_get_source_gamut(struct mod_color *mod_color, > - const struct dc_sink *sink, > - struct color_space_coordinates *source_gamut) > -{ > - struct core_color *core_color = > - MOD_COLOR_TO_CORE(mod_color); > - > - int sink_index = sink_index_from_sink(core_color, sink); > - > - if (sink_index == -1) > - return false; > - > - *source_gamut = core_color->state[sink_index].source_gamut.gamut; > - > - return true; > -} > - > -bool mod_color_notify_mode_change(struct mod_color *mod_color, > - const struct dc_stream **streams, int num_streams) > -{ > - struct core_color *core_color = MOD_COLOR_TO_CORE(mod_color); > - > - struct gamut_src_dst_matrix *matrix = > - dm_alloc(sizeof(struct gamut_src_dst_matrix)); > - > - unsigned int stream_index, j; > - int sink_index; > - > - for (stream_index = 0; stream_index < num_streams; stream_index++) { > - sink_index = sink_index_from_sink(core_color, > - streams[stream_index]->sink); > - if (sink_index == -1) > - continue; > - > - if (!build_gamut_remap_matrix > - (core_color->state[sink_index].source_gamut.gamut, > - matrix->rgbCoeffSrc, > - matrix->whiteCoeffSrc)) > - goto function_fail; > - > - if (!build_gamut_remap_matrix > - (core_color->state[sink_index]. > - destination_gamut.gamut, > - matrix->rgbCoeffDst, matrix->whiteCoeffDst)) > - goto function_fail; > - > - struct fixed31_32 gamut_result[12]; > - struct fixed31_32 temp_matrix[9]; > - > - if (!gamut_to_color_matrix( > - matrix->rgbCoeffDst, > - matrix->whiteCoeffDst, > - matrix->rgbCoeffSrc, > - matrix->whiteCoeffSrc, > - true, > - temp_matrix)) > - goto function_fail; > - > - gamut_result[0] = temp_matrix[0]; > - gamut_result[1] = temp_matrix[1]; > - gamut_result[2] = temp_matrix[2]; > - gamut_result[3] = matrix->whiteCoeffSrc[0]; > - gamut_result[4] = temp_matrix[3]; > - gamut_result[5] = temp_matrix[4]; > - gamut_result[6] = temp_matrix[5]; > - gamut_result[7] = matrix->whiteCoeffSrc[1]; > - gamut_result[8] = temp_matrix[6]; > - gamut_result[9] = temp_matrix[7]; > - gamut_result[10] = temp_matrix[8]; > - gamut_result[11] = matrix->whiteCoeffSrc[2]; > - > - > - struct core_stream *core_stream = > - DC_STREAM_TO_CORE > - (streams[stream_index]); > - > - core_stream->public.gamut_remap_matrix.enable_remap = true; > - > - for (j = 0; j < 12; j++) > - core_stream->public. > - gamut_remap_matrix.matrix[j] = > - gamut_result[j]; > - > - calculate_csc_matrix(core_color, sink_index, > - core_stream->public.output_color_space, > - core_stream->public.csc_color_matrix.matrix); > - > - core_stream->public.csc_color_matrix.enable_adjustment = true; > - } > - > - dm_free(matrix); > - > - return true; > - > -function_fail: > - dm_free(matrix); > - return false; > -} > - > -bool mod_color_set_brightness(struct mod_color *mod_color, > - const struct dc_stream **streams, int num_streams, > - int brightness_value) > -{ > - struct core_color *core_color = MOD_COLOR_TO_CORE(mod_color); > - struct core_dc *core_dc = DC_TO_CORE(core_color->dc); > - struct persistent_data_flag flag; > - unsigned int stream_index; > - int sink_index; > - > - for (stream_index = 0; stream_index < num_streams; stream_index++) { > - sink_index = sink_index_from_sink(core_color, > - streams[stream_index]->sink); > - if (sink_index == -1) > - continue; > - > - struct core_stream *core_stream = > - DC_STREAM_TO_CORE > - (streams[stream_index]); > - > - core_color->state[sink_index].brightness.current = > - brightness_value; > - > - calculate_csc_matrix(core_color, sink_index, > - core_stream->public.output_color_space, > - core_stream->public.csc_color_matrix.matrix); > - > - core_stream->public.csc_color_matrix.enable_adjustment = true; > - > - /* Write persistent data in registry*/ > - flag.save_per_edid = true; > - flag.save_per_link = false; > - dm_write_persistent_data(core_dc->ctx, > - streams[stream_index]->sink, > - COLOR_REGISTRY_NAME, > - "brightness", > - &brightness_value, > - sizeof(int), > - &flag); > - } > - > - core_color->dc->stream_funcs.set_gamut_remap > - (core_color->dc, streams, num_streams); > - > - return true; > -} > - > -bool mod_color_set_contrast(struct mod_color *mod_color, > - const struct dc_stream **streams, int num_streams, > - int contrast_value) > -{ > - struct core_color *core_color = MOD_COLOR_TO_CORE(mod_color); > - struct core_dc *core_dc = DC_TO_CORE(core_color->dc); > - struct persistent_data_flag flag; > - unsigned int stream_index; > - int sink_index; > - > - for (stream_index = 0; stream_index < num_streams; stream_index++) { > - sink_index = sink_index_from_sink(core_color, > - streams[stream_index]->sink); > - if (sink_index == -1) > - continue; > - > - struct core_stream *core_stream = > - DC_STREAM_TO_CORE > - (streams[stream_index]); > - > - core_color->state[sink_index].contrast.current = > - contrast_value; > - > - calculate_csc_matrix(core_color, sink_index, > - core_stream->public.output_color_space, > - core_stream->public.csc_color_matrix.matrix); > - > - core_stream->public.csc_color_matrix.enable_adjustment = true; > - > - /* Write persistent data in registry*/ > - flag.save_per_edid = true; > - flag.save_per_link = false; > - dm_write_persistent_data(core_dc->ctx, > - streams[stream_index]->sink, > - COLOR_REGISTRY_NAME, > - "contrast", > - &contrast_value, > - sizeof(int), > - &flag); > - } > - > - core_color->dc->stream_funcs.set_gamut_remap > - (core_color->dc, streams, num_streams); > - > - return true; > -} > - > -bool mod_color_set_hue(struct mod_color *mod_color, > - const struct dc_stream **streams, int num_streams, > - int hue_value) > -{ > - struct core_color *core_color = MOD_COLOR_TO_CORE(mod_color); > - struct core_dc *core_dc = DC_TO_CORE(core_color->dc); > - struct persistent_data_flag flag; > - unsigned int stream_index; > - int sink_index; > - > - for (stream_index = 0; stream_index < num_streams; stream_index++) { > - sink_index = sink_index_from_sink(core_color, > - streams[stream_index]->sink); > - if (sink_index == -1) > - continue; > - > - struct core_stream *core_stream = > - DC_STREAM_TO_CORE > - (streams[stream_index]); > - > - core_color->state[sink_index].hue.current = hue_value; > - > - calculate_csc_matrix(core_color, sink_index, > - core_stream->public.output_color_space, > - core_stream->public.csc_color_matrix.matrix); > - > - core_stream->public.csc_color_matrix.enable_adjustment = true; > - > - /* Write persistent data in registry*/ > - flag.save_per_edid = true; > - flag.save_per_link = false; > - dm_write_persistent_data(core_dc->ctx, > - streams[stream_index]->sink, > - COLOR_REGISTRY_NAME, > - "hue", > - &hue_value, > - sizeof(int), > - &flag); > - } > - > - core_color->dc->stream_funcs.set_gamut_remap > - (core_color->dc, streams, num_streams); > - > - return true; > -} > - > -bool mod_color_set_saturation(struct mod_color *mod_color, > - const struct dc_stream **streams, int num_streams, > - int saturation_value) > -{ > - struct core_color *core_color = MOD_COLOR_TO_CORE(mod_color); > - struct core_dc *core_dc = DC_TO_CORE(core_color->dc); > - struct persistent_data_flag flag; > - unsigned int stream_index; > - int sink_index; > - > - for (stream_index = 0; stream_index < num_streams; stream_index++) { > - sink_index = sink_index_from_sink(core_color, > - streams[stream_index]->sink); > - if (sink_index == -1) > - continue; > - > - struct core_stream *core_stream = > - DC_STREAM_TO_CORE > - (streams[stream_index]); > - > - core_color->state[sink_index].saturation.current = > - saturation_value; > - > - calculate_csc_matrix(core_color, sink_index, > - core_stream->public.output_color_space, > - core_stream->public.csc_color_matrix.matrix); > - > - core_stream->public.csc_color_matrix.enable_adjustment = true; > - > - /* Write persistent data in registry*/ > - flag.save_per_edid = true; > - flag.save_per_link = false; > - dm_write_persistent_data(core_dc->ctx, > - streams[stream_index]->sink, > - COLOR_REGISTRY_NAME, > - "saturation", > - &saturation_value, > - sizeof(int), > - &flag); > - } > - > - core_color->dc->stream_funcs.set_gamut_remap > - (core_color->dc, streams, num_streams); > - > - return true; > -} > - > -bool mod_color_set_input_gamma_correction(struct mod_color *mod_color, > - const struct dc_stream **streams, int num_streams, > - struct dc_gamma *gamma) > -{ > - struct core_color *core_color = MOD_COLOR_TO_CORE(mod_color); > - unsigned int stream_index; > - int sink_index; > - > - for (stream_index = 0; stream_index < num_streams; stream_index++) { > - sink_index = sink_index_from_sink(core_color, > - streams[stream_index]->sink); > - if (sink_index == -1) > - continue; > - > - struct dc_surface *surface = > - dc_stream_to_surface_from_pipe_ctx(core_color, > - streams[stream_index]); > - > - if (surface != NULL) { > - struct dc_transfer_func *input_tf = > - dc_create_transfer_func(); > - struct dc_surface_update updates = {0}; > - > - if (input_tf != NULL) { > - input_tf->type = TF_TYPE_PREDEFINED; > - input_tf->tf = TRANSFER_FUNCTION_SRGB; > - } > - > - if (core_color->state[sink_index].gamma != gamma) { > - if (core_color->state[sink_index].gamma) > - dc_gamma_release( > - &core_color->state[sink_index].gamma); > - > - dc_gamma_retain(gamma); > - core_color->state[sink_index].gamma = gamma; > - } > - > - updates.surface = surface; > - updates.gamma = gamma; > - updates.in_transfer_func = input_tf; > - dc_update_surfaces_for_target(core_color->dc, &updates, > - 1, NULL); > - > - if (input_tf != NULL) > - dc_transfer_func_release(input_tf); > - } > - } > - > - return true; > -} > - > -bool mod_color_persist_user_preferred_quantization_range( > - struct mod_color *mod_color, > - const struct dc_sink *sink, > - enum dc_quantization_range quantization_range) > -{ > - struct core_color *core_color = MOD_COLOR_TO_CORE(mod_color); > - struct core_dc *core_dc = DC_TO_CORE(core_color->dc); > - struct persistent_data_flag flag; > - int sink_index; > - > - sink_index = sink_index_from_sink(core_color, sink); > - if (sink_index == -1) > - return false; > - > - if (core_color->state[sink_index]. > - preferred_quantization_range != quantization_range) { > - core_color->state[sink_index].preferred_quantization_range = > - quantization_range; > - flag.save_per_edid = true; > - flag.save_per_link = false; > - dm_write_persistent_data(core_dc->ctx, > - sink, > - COLOR_REGISTRY_NAME, > - "quantization_range", > - &quantization_range, > - sizeof(int), > - &flag); > - } > - > - return true; > -} > - > -bool mod_color_get_preferred_quantization_range(struct mod_color *mod_color, > - const struct dc_sink *sink, > - const struct dc_crtc_timing *timing, > - enum dc_quantization_range *quantization_range) > -{ > - struct core_color *core_color = MOD_COLOR_TO_CORE(mod_color); > - int sink_index = sink_index_from_sink(core_color, sink); > - > - if (sink_index == -1) > - return false; > - > - enum dc_quantization_range user_preferred_quantization_range = > - core_color->state[sink_index]. > - preferred_quantization_range; > - bool rgb_full_range_supported = > - mod_color_is_rgb_full_range_supported_for_timing( > - sink, timing); > - bool rgb_limited_range_supported = > - mod_color_is_rgb_limited_range_supported_for_timing( > - sink, timing); > - > - if (rgb_full_range_supported && rgb_limited_range_supported) > - *quantization_range = user_preferred_quantization_range; > - else if (rgb_full_range_supported && !rgb_limited_range_supported) > - *quantization_range = QUANTIZATION_RANGE_FULL; > - else if (!rgb_full_range_supported && rgb_limited_range_supported) > - *quantization_range = QUANTIZATION_RANGE_LIMITED; > - else > - *quantization_range = QUANTIZATION_RANGE_UNKNOWN; > - > - return true; > -} > - > -bool mod_color_is_rgb_full_range_supported_for_timing( > - const struct dc_sink *sink, > - const struct dc_crtc_timing *timing) > -{ > - bool result = false; > - > - if (!sink || !timing) > - return result; > - > - if (sink->sink_signal == SIGNAL_TYPE_HDMI_TYPE_A) > - if (timing->vic || timing->hdmi_vic) > - if (timing->h_addressable == 640 && > - timing->v_addressable == 480 && > - (timing->pix_clk_khz == 25200 || > - timing->pix_clk_khz == 25170 || > - timing->pix_clk_khz == 25175)) > - result = true; > - else > - /* don't support full range rgb */ > - /* for HDMI CEA861 timings except VGA mode */ > - result = false; > - else > - result = true; > - else > - result = true; > - > - return result; > -} > - > -bool mod_color_is_rgb_limited_range_supported_for_timing( > - const struct dc_sink *sink, > - const struct dc_crtc_timing *timing) > -{ > - bool result = false; > - > - if (!sink || !timing) > - return result; > - > - if (sink->sink_signal == SIGNAL_TYPE_HDMI_TYPE_A) > - if (timing->vic || timing->hdmi_vic) > - if (timing->h_addressable == 640 && > - timing->v_addressable == 480 && > - (timing->pix_clk_khz == 25200 || > - timing->pix_clk_khz == 25170 || > - timing->pix_clk_khz == 25175)) > - /* don't support rgb limited for */ > - /* HDMI CEA VGA mode */ > - result = false; > - else > - /* support rgb limited for non VGA CEA timing */ > - result = true; > - else > - /* support rgb limited for non CEA HDMI timing */ > - result = true; > - else > - /* don't support rgb limited for non HDMI signal */ > - result = false; > - > - return result; > -} > - > -bool mod_color_set_regamma(struct mod_color *mod_color, > - const struct dc_stream **streams, int num_streams) > -{ > - /*TODO*/ > - return true; > -} > - > -bool mod_color_set_degamma(struct mod_color *mod_color, > - const struct dc_stream **streams, int num_streams, > - enum color_transfer_func transfer_function) > -{ > - /*TODO*/ > - return true; > -} > - > -bool mod_color_update_gamut_info(struct mod_color *mod_color, > - const struct dc_stream **streams, int num_streams) > -{ > - struct core_color *core_color = MOD_COLOR_TO_CORE(mod_color); > - unsigned int stream_index; > - int sink_index; > - bool should_defer = false; > - bool is_hdr = false; > - enum color_color_space source_color_space; > - enum color_transfer_func input_transfer_function; > - struct color_gamut_data new_gamut_source; > - struct color_gamut_data new_gamut_destination; > - > - for (stream_index = 0; stream_index < num_streams; stream_index++) { > - sink_index = sink_index_from_sink(core_color, > - streams[stream_index]->sink); > - if (sink_index == -1) > - continue; > - source_color_space = > - core_color->state[sink_index].source_gamut.color_space; > - input_transfer_function = > - core_color->state[sink_index].input_transfer_function; > - new_gamut_source.color_space = source_color_space; > - new_gamut_destination.color_space = > - core_color->state[sink_index]. > - destination_gamut.color_space; > - > - struct dc_surface *surface = > - dc_stream_to_surface_from_pipe_ctx(core_color, > - streams[stream_index]); > - if (surface == NULL) > - return false; > - > - if (surface->format == SURFACE_PIXEL_FORMAT_GRPH_ARGB8888 || > - surface->format == > - SURFACE_PIXEL_FORMAT_GRPH_ARGB2101010) { > - > - if (input_transfer_function == > - transfer_func_pq2084 || > - input_transfer_function == > - transfer_func_pq2084_interim) { > - /* For PQ and PQ interim, we bypass degamma+ > - * remap+regamma, application needs to also > - * handle gamut remapping > - */ > - /* TODO */ > - is_hdr = true; > - } else if (input_transfer_function == > - transfer_func_linear_0_1 || > - input_transfer_function == > - transfer_func_linear_0_125) { > - /* TF not supported in current surface format, > - * but may be deferred to a later flip > - */ > - should_defer = true; > - } else { > - new_gamut_destination.color_space = > - color_space_srgb; > - } > - } else if (surface->format == > - SURFACE_PIXEL_FORMAT_GRPH_ARGB16161616F || > - surface->format == > - SURFACE_PIXEL_FORMAT_GRPH_ABGR16161616F || > - surface->format == > - SURFACE_PIXEL_FORMAT_GRPH_ARGB16161616) { > - if (input_transfer_function == > - transfer_func_linear_0_125) { > - /* Regamma PQ for HDR supported displays and > - * 0-125 source > - */ > - if ((core_color->edid_caps[sink_index]. > - hdr_caps) & smpte_st2084) > - is_hdr = true; > - > - /* override for BT.2020 whenever PQ */ > - if (core_color->state[sink_index]. > - destination_gamut.color_space != > - color_space_bt2020) { > - if (streams[stream_index]->timing. > - pixel_encoding == > - PIXEL_ENCODING_RGB) { > - if ((core_color-> > - edid_caps[sink_index]. > - colorimetry_caps) & bt_2020_rgb) > - new_gamut_destination. > - color_space = > - color_space_bt2020; > - } else { > - if ((core_color-> > - edid_caps[sink_index]. > - colorimetry_caps) & bt_2020_ycc) > - new_gamut_destination. > - color_space = > - color_space_bt2020; > - } > - } > - } else if (input_transfer_function == > - transfer_func_linear_0_1) { > - new_gamut_destination.color_space = > - color_space_srgb; > - } else { > - /* TF not supported in current surface format, > - * but may be deferred to a later flip > - */ > - should_defer = true; > - } > - } > - > - /* 0. ---- CHECK DEFERRED ---- */ > - if (should_defer) > - return true; > - > - /* 1. ---- SET GAMUT SOURCE ---- */ > - new_gamut_source.white_point = core_color->state[sink_index]. > - source_gamut.white_point; > - update_color_gamut_data(&new_gamut_source, > - &core_color->state[sink_index].source_gamut); > - > - /* 2. ---- SET GAMUT DESTINATION ---- */ > - new_gamut_destination.white_point = > - core_color->state[sink_index]. > - destination_gamut.white_point; > - update_color_gamut_data(&new_gamut_destination, > - &core_color->state[sink_index].destination_gamut); > - > - /* 3. ---- SET DEGAMMA ---- */ > - struct dc_transfer_func *input_tf = NULL; > - > - input_tf = dc_create_transfer_func(); > - > - if (input_tf != NULL) { > - input_tf->type = TF_TYPE_PREDEFINED; > - > - switch (input_transfer_function) { > - case transfer_func_srgb: > - input_tf->tf = TRANSFER_FUNCTION_SRGB; > - break; > - case transfer_func_linear_0_1: > - case transfer_func_linear_0_125: > - input_tf->tf = TRANSFER_FUNCTION_LINEAR; > - break; > - default: > - dc_transfer_func_release(input_tf); > - input_tf = NULL; > - break; > - } > - } > - > - /* 4. ---- SET REGAMMA ---- */ > - struct dc_transfer_func *output_tf = NULL; > - > - output_tf = dc_create_transfer_func(); > - > - if (output_tf != NULL) { > - output_tf->type = TF_TYPE_PREDEFINED; > - if (is_hdr) > - output_tf->tf = TRANSFER_FUNCTION_PQ; > - else > - output_tf->tf = TRANSFER_FUNCTION_SRGB; > - } > - /* 5. ---- POPULATE HDR METADATA ---- */ > - core_color->state[sink_index].mastering_info.is_hdr = is_hdr; > - > - /* 6. ---- TODO: UPDATE INFOPACKETS ---- */ > - > - if (!mod_color_update_gamut_to_stream( > - mod_color, streams, num_streams)) > - return false; > - > - struct dc_surface_update updates[4] = {0}; > - > - updates[0].surface = surface; > - updates[0].gamma = core_color->state[sink_index].gamma; > - updates[0].in_transfer_func = input_tf; > - updates[0].out_transfer_func = output_tf; > - updates[0].hdr_static_metadata = > - &core_color->state[sink_index].mastering_info; > - > - dc_update_surfaces_for_target(core_color->dc, updates, 1, NULL); > - > - if (input_tf != NULL) > - dc_transfer_func_release(input_tf); > - > - if (output_tf != NULL) > - dc_transfer_func_release(output_tf); > - } > - return true; > -} > diff --git a/drivers/gpu/drm/amd/display/modules/color/color_helper.c b/drivers/gpu/drm/amd/display/modules/color/color_helper.c > deleted file mode 100644 > index ff6779cdd623..000000000000 > --- a/drivers/gpu/drm/amd/display/modules/color/color_helper.c > +++ /dev/null > @@ -1,210 +0,0 @@ > -/* > - * Copyright 2016 Advanced Micro Devices, Inc. > - * > - * Permission is hereby granted, free of charge, to any person obtaining a > - * copy of this software and associated documentation files (the "Software"), > - * to deal in the Software without restriction, including without limitation > - * the rights to use, copy, modify, merge, publish, distribute, sublicense, > - * and/or sell copies of the Software, and to permit persons to whom the > - * Software is furnished to do so, subject to the following conditions: > - * > - * The above copyright notice and this permission notice shall be included in > - * all copies or substantial portions of the Software. > - * > - * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR > - * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, > - * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL > - * THE COPYRIGHT HOLDER(S) OR AUTHOR(S) BE LIABLE FOR ANY CLAIM, DAMAGES OR > - * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, > - * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR > - * OTHER DEALINGS IN THE SOFTWARE. > - * > - * Authors: AMD > - * > - */ > - > -#include "dm_services.h" > -#include "dc.h" > -#include "mod_color.h" > -#include "color_helper.h" > - > -const struct gamut_space_entry predefined_gamuts[] = { > - /* x_red y_red x_gr y_gr x_blue y_blue a0 a1 a2 a3 gamma */ > - [gamut_type_bt709] = {6400, 3300, 3000, 6000, 1500, 600, 180000, 4500, 99, 99, 2200}, > - [gamut_type_bt601] = {6400, 3300, 2900, 6000, 1500, 600, 180000, 4500, 99, 99, 2200}, > - [gamut_type_adobe_rgb] = {6400, 3300, 2100, 7100, 1500, 600, 180000, 4500, 99, 99, 2200}, > - [gamut_type_srgb] = {6400, 3300, 3000, 6000, 1500, 600, 31308, 12920, 55, 55, 2400}, > - [gamut_type_bt2020] = {7080, 2920, 1700, 7970, 1310, 460, 180000, 4500, 99, 99, 2200} > -}; > - > -const struct white_point_coodinates_entry predefined_white_points[] = { > - [white_point_type_5000k_horizon] = {5000, 3473, 3561}, > - [white_point_type_6500k_noon] = {6500, 3127, 3290}, > - [white_point_type_7500k_north_sky] = {7500, 3022, 3129}, > - [white_point_type_9300k] = {9300, 2866, 2950} > -}; > - > -const unsigned int white_point_entries = 91; > - > -const struct white_point_coodinates_entry white_point_temps[] = { > - /*001*/{1000, 6499, 3474}, > - /*002*/{1100, 6361, 3594}, > - /*003*/{1200, 6226, 3703}, > - /*004*/{1300, 6095, 3801}, > - /*005*/{1400, 5966, 3887}, > - /*006*/{1500, 5841, 3962}, > - /*007*/{1600, 5720, 4025}, > - /*008*/{1700, 5601, 4076}, > - /*009*/{1800, 5486, 4118}, > - /*010*/{1900, 5375, 4150}, > - /*011*/{2000, 5267, 4173}, > - /*012*/{2100, 5162, 4188}, > - /*013*/{2200, 5062, 4196}, > - /*014*/{2300, 4965, 4198}, > - /*015*/{2400, 4872, 4194}, > - /*016*/{2500, 4782, 4186}, > - /*017*/{2600, 4696, 4173}, > - /*018*/{2700, 4614, 4158}, > - /*019*/{2800, 4535, 4139}, > - /*020*/{2900, 4460, 4118}, > - /*021*/{3000, 4388, 4095}, > - /*022*/{3100, 4320, 4070}, > - /*023*/{3200, 4254, 4044}, > - /*024*/{3300, 4192, 4018}, > - /*025*/{3400, 4132, 3990}, > - /*026*/{3500, 4075, 3962}, > - /*027*/{3600, 4021, 3934}, > - /*028*/{3700, 3969, 3905}, > - /*029*/{3800, 3919, 3877}, > - /*030*/{3900, 3872, 3849}, > - /*031*/{4000, 3827, 3820}, > - /*032*/{4100, 3784, 3793}, > - /*033*/{4200, 3743, 3765}, > - /*034*/{4300, 3704, 3738}, > - /*035*/{4400, 3666, 3711}, > - /*036*/{4500, 3631, 3685}, > - /*037*/{4600, 3596, 3659}, > - /*038*/{4700, 3563, 3634}, > - /*039*/{4800, 3532, 3609}, > - /*040*/{4900, 3502, 3585}, > - /*041*/{5000, 3473, 3561}, > - /*042*/{5100, 3446, 3538}, > - /*043*/{5200, 3419, 3516}, > - /*044*/{5300, 3394, 3494}, > - /*045*/{5400, 3369, 3472}, > - /*046*/{5500, 3346, 3451}, > - /*047*/{5600, 3323, 3431}, > - /*048*/{5700, 3302, 3411}, > - /*049*/{5800, 3281, 3392}, > - /*050*/{5900, 3261, 3373}, > - /*051*/{6000, 3242, 3355}, > - /*052*/{6100, 3223, 3337}, > - /*053*/{6200, 3205, 3319}, > - /*054*/{6300, 3188, 3302}, > - /*055*/{6400, 3161, 3296}, > - /*056*/{6500, 3127, 3290}, /* This is the real white point sRGB */ > - /*057*/{6600, 3126, 3264}, > - /*058*/{6700, 3125, 3238}, > - /*059*/{6800, 3110, 3224}, > - /*060*/{6900, 3097, 3209}, > - /*061*/{7000, 3083, 3195}, > - /*062*/{7100, 3070, 3181}, > - /*063*/{7200, 3058, 3168}, > - /*064*/{7300, 3045, 3154}, > - /*065*/{7400, 3034, 3142}, > - /*066*/{7500, 3022, 3129}, > - /*067*/{7600, 3011, 3117}, > - /*068*/{7700, 3000, 3105}, > - /*069*/{7800, 2990, 3094}, > - /*070*/{7900, 2980, 3082}, > - /*071*/{8000, 2970, 3071}, > - /*072*/{8100, 2961, 3061}, > - /*073*/{8200, 2952, 3050}, > - /*074*/{8300, 2943, 3040}, > - /*075*/{8400, 2934, 3030}, > - /*076*/{8500, 2926, 3020}, > - /*077*/{8600, 2917, 3011}, > - /*078*/{8700, 2910, 3001}, > - /*079*/{8800, 2902, 2992}, > - /*080*/{8900, 2894, 2983}, > - /*081*/{9000, 2887, 2975}, > - /*082*/{9100, 2880, 2966}, > - /*083*/{9200, 2873, 2958}, > - /*084*/{9300, 2866, 2950}, > - /*085*/{9400, 2860, 2942}, > - /*086*/{9500, 2853, 2934}, > - /*087*/{9600, 2847, 2927}, > - /*088*/{9700, 2841, 2919}, > - /*089*/{9800, 2835, 2912}, > - /*090*/{9900, 2829, 2905}, > - /*091*/{10000, 2824, 2898} > -}; > - > -bool mod_color_find_predefined_gamut( > - struct gamut_space_coordinates *out_gamut, > - enum predefined_gamut_type type) > -{ > - out_gamut->redX = predefined_gamuts[type].redX; > - out_gamut->redY = predefined_gamuts[type].redY; > - out_gamut->greenX = predefined_gamuts[type].greenX; > - out_gamut->greenY = predefined_gamuts[type].greenY; > - out_gamut->blueX = predefined_gamuts[type].blueX; > - out_gamut->blueY = predefined_gamuts[type].blueY; > - > - return true; > -} > - > -bool mod_color_find_predefined_white_point( > - struct white_point_coodinates *out_white_point, > - enum predefined_white_point_type type) > -{ > - out_white_point->whiteX = predefined_white_points[type].whiteX; > - out_white_point->whiteY = predefined_white_points[type].whiteY; > - > - return true; > -} > - > -bool mod_color_find_white_point_from_temperature( > - struct white_point_coodinates *out_white_point, > - unsigned int temperature) > -{ > - int i; > - unsigned int found = false; > - struct white_point_coodinates_entry temp_white_point = > - white_point_temps[55]; > - > - if (temperature < 1000 || temperature > 10000) > - return false; > - > - for (i = 0; i < white_point_entries; i++) { > - if (temperature == white_point_temps[i].temperature) { > - temp_white_point = white_point_temps[i]; > - found = true; > - break; > - } > - } > - > - out_white_point->whiteX = temp_white_point.whiteX; > - out_white_point->whiteY = temp_white_point.whiteY; > - > - return found; > -} > - > -bool mod_color_find_temperature_from_white_point( > - struct white_point_coodinates *in_white_point, > - unsigned int *out_temperature) > -{ > - unsigned int i; > - *out_temperature = 6500; > - > - for (i = 0; i < white_point_entries; i++) { > - if (in_white_point->whiteX == white_point_temps[i].whiteX && > - in_white_point->whiteY == white_point_temps[i].whiteY) { > - *out_temperature = white_point_temps[i].temperature; > - return true; > - } > - } > - > - return false; > -} > - > diff --git a/drivers/gpu/drm/amd/display/modules/color/color_helper.h b/drivers/gpu/drm/amd/display/modules/color/color_helper.h > deleted file mode 100644 > index 76575c1dc043..000000000000 > --- a/drivers/gpu/drm/amd/display/modules/color/color_helper.h > +++ /dev/null > @@ -1,62 +0,0 @@ > -/* > - * Copyright 2016 Advanced Micro Devices, Inc. > - * > - * Permission is hereby granted, free of charge, to any person obtaining a > - * copy of this software and associated documentation files (the "Software"), > - * to deal in the Software without restriction, including without limitation > - * the rights to use, copy, modify, merge, publish, distribute, sublicense, > - * and/or sell copies of the Software, and to permit persons to whom the > - * Software is furnished to do so, subject to the following conditions: > - * > - * The above copyright notice and this permission notice shall be included in > - * all copies or substantial portions of the Software. > - * > - * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR > - * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, > - * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL > - * THE COPYRIGHT HOLDER(S) OR AUTHOR(S) BE LIABLE FOR ANY CLAIM, DAMAGES OR > - * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, > - * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR > - * OTHER DEALINGS IN THE SOFTWARE. > - * > - * Authors: AMD > - * > - */ > - > -#ifndef COLOR_MOD_COLOR_HELPER_H_ > -#define COLOR_MOD_COLOR_HELPER_H_ > - > -enum predefined_gamut_type { > - gamut_type_bt709, > - gamut_type_bt601, > - gamut_type_adobe_rgb, > - gamut_type_srgb, > - gamut_type_bt2020, > - gamut_type_unknown, > -}; > - > -enum predefined_white_point_type { > - white_point_type_5000k_horizon, > - white_point_type_6500k_noon, > - white_point_type_7500k_north_sky, > - white_point_type_9300k, > - white_point_type_unknown, > -}; > - > -bool mod_color_find_predefined_gamut( > - struct gamut_space_coordinates *out_gamut, > - enum predefined_gamut_type type); > - > -bool mod_color_find_predefined_white_point( > - struct white_point_coodinates *out_white_point, > - enum predefined_white_point_type type); > - > -bool mod_color_find_white_point_from_temperature( > - struct white_point_coodinates *out_white_point, > - unsigned int temperature); > - > -bool mod_color_find_temperature_from_white_point( > - struct white_point_coodinates *in_white_point, > - unsigned int *out_temperature); > - > -#endif /* COLOR_MOD_COLOR_HELPER_H_ */ > diff --git a/drivers/gpu/drm/amd/display/modules/inc/mod_color.h b/drivers/gpu/drm/amd/display/modules/inc/mod_color.h > deleted file mode 100644 > index 70349a88916c..000000000000 > --- a/drivers/gpu/drm/amd/display/modules/inc/mod_color.h > +++ /dev/null > @@ -1,282 +0,0 @@ > -/* > - * Copyright 2016 Advanced Micro Devices, Inc. > - * > - * Permission is hereby granted, free of charge, to any person obtaining a > - * copy of this software and associated documentation files (the "Software"), > - * to deal in the Software without restriction, including without limitation > - * the rights to use, copy, modify, merge, publish, distribute, sublicense, > - * and/or sell copies of the Software, and to permit persons to whom the > - * Software is furnished to do so, subject to the following conditions: > - * > - * The above copyright notice and this permission notice shall be included in > - * all copies or substantial portions of the Software. > - * > - * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR > - * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, > - * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL > - * THE COPYRIGHT HOLDER(S) OR AUTHOR(S) BE LIABLE FOR ANY CLAIM, DAMAGES OR > - * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, > - * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR > - * OTHER DEALINGS IN THE SOFTWARE. > - * > - * Authors: AMD > - * > - */ > - > - > -#ifndef MOD_COLOR_H_ > -#define MOD_COLOR_H_ > - > -#include "dm_services.h" > -#include "color_helper.h" > - > -enum color_transfer_func { > - transfer_func_unknown, > - transfer_func_srgb, > - transfer_func_bt709, > - transfer_func_pq2084, > - transfer_func_pq2084_interim, > - transfer_func_linear_0_1, > - transfer_func_linear_0_125, > - transfer_func_dolbyvision, > - transfer_func_gamma_22, > - transfer_func_gamma_26 > -}; > - > -enum color_color_space { > - color_space_unsupported, > - color_space_srgb, > - color_space_bt601, > - color_space_bt709, > - color_space_xv_ycc_bt601, > - color_space_xv_ycc_bt709, > - color_space_xr_rgb, > - color_space_bt2020, > - color_space_adobe, > - color_space_dci_p3, > - color_space_sc_rgb_ms_ref, > - color_space_display_native, > - color_space_app_ctrl, > - color_space_dolby_vision, > - color_space_custom_coordinates > -}; > - > -enum color_white_point_type { > - color_white_point_type_unknown, > - color_white_point_type_5000k_horizon, > - color_white_point_type_6500k_noon, > - color_white_point_type_7500k_north_sky, > - color_white_point_type_9300k, > - color_white_point_type_custom_coordinates > -}; > - > -enum colorimetry_support_flag { > - xv_ycc_bt601 = 0x01, > - xv_ycc_bt709 = 0x02, > - s_ycc_601 = 0x04, > - adobe_ycc_601 = 0x08, > - adobe_rgb = 0x10, > - bt_2020_c_ycc = 0x20, > - bt_2020_ycc = 0x40, > - bt_2020_rgb = 0x80 > -}; > - > -enum hdr_tf_support_flag { > - traditional_gamma_sdr = 0x01, > - traditional_gamma_hdr = 0x02, > - smpte_st2084 = 0x04 > -}; > - > -struct mod_color { > - int dummy; > -}; > - > -struct color_space_coordinates { > - unsigned int redX; > - unsigned int redY; > - unsigned int greenX; > - unsigned int greenY; > - unsigned int blueX; > - unsigned int blueY; > - unsigned int whiteX; > - unsigned int whiteY; > -}; > - > -struct gamut_space_coordinates { > - unsigned int redX; > - unsigned int redY; > - unsigned int greenX; > - unsigned int greenY; > - unsigned int blueX; > - unsigned int blueY; > -}; > - > -struct gamut_space_entry { > - unsigned int redX; > - unsigned int redY; > - unsigned int greenX; > - unsigned int greenY; > - unsigned int blueX; > - unsigned int blueY; > - > - int a0; > - int a1; > - int a2; > - int a3; > - int gamma; > -}; > - > -struct white_point_coodinates { > - unsigned int whiteX; > - unsigned int whiteY; > -}; > - > -struct white_point_coodinates_entry { > - unsigned int temperature; > - unsigned int whiteX; > - unsigned int whiteY; > -}; > - > -struct color_range { > - int current; > - int min; > - int max; > -}; > - > -struct color_gamut_data { > - enum color_color_space color_space; > - enum color_white_point_type white_point; > - struct color_space_coordinates gamut; > -}; > - > -struct color_edid_caps { > - unsigned int colorimetry_caps; > - unsigned int hdr_caps; > -}; > - > -struct mod_color *mod_color_create(struct dc *dc); > - > -void mod_color_destroy(struct mod_color *mod_color); > - > -bool mod_color_add_sink(struct mod_color *mod_color, > - const struct dc_sink *sink, struct color_edid_caps *edid_caps); > - > -bool mod_color_remove_sink(struct mod_color *mod_color, > - const struct dc_sink *sink); > - > -bool mod_color_update_gamut_to_stream(struct mod_color *mod_color, > - const struct dc_stream **streams, int num_streams); > - > -bool mod_color_set_white_point(struct mod_color *mod_color, > - const struct dc_stream **streams, int num_streams, > - struct white_point_coodinates *white_point); > - > -bool mod_color_adjust_source_gamut(struct mod_color *mod_color, > - const struct dc_stream **streams, int num_streams, > - struct color_gamut_data *input_gamut_data); > - > -bool mod_color_adjust_destination_gamut(struct mod_color *mod_color, > - const struct dc_stream **streams, int num_streams, > - struct color_gamut_data *input_gamut_data); > - > -bool mod_color_adjust_source_gamut_and_tf(struct mod_color *mod_color, > - const struct dc_stream **streams, int num_streams, > - struct color_gamut_data *input_gamut_data, > - enum color_transfer_func input_transfer_func); > - > -bool mod_color_get_user_enable(struct mod_color *mod_color, > - const struct dc_sink *sink, > - bool *user_enable); > - > -bool mod_color_set_mastering_info(struct mod_color *mod_color, > - const struct dc_stream **streams, int num_streams, > - const struct dc_hdr_static_metadata *mastering_info); > - > -bool mod_color_get_mastering_info(struct mod_color *mod_color, > - const struct dc_sink *sink, > - struct dc_hdr_static_metadata *mastering_info); > - > -bool mod_color_set_user_enable(struct mod_color *mod_color, > - const struct dc_stream **streams, int num_streams, > - bool user_enable); > - > -bool mod_color_get_custom_color_temperature(struct mod_color *mod_color, > - const struct dc_sink *sink, > - int *color_temperature); > - > -bool mod_color_set_custom_color_temperature(struct mod_color *mod_color, > - const struct dc_stream **streams, int num_streams, > - int color_temperature); > - > -bool mod_color_get_color_saturation(struct mod_color *mod_color, > - const struct dc_sink *sink, > - struct color_range *color_saturation); > - > -bool mod_color_get_color_contrast(struct mod_color *mod_color, > - const struct dc_sink *sink, > - struct color_range *color_contrast); > - > -bool mod_color_get_color_brightness(struct mod_color *mod_color, > - const struct dc_sink *sink, > - struct color_range *color_brightness); > - > -bool mod_color_get_color_hue(struct mod_color *mod_color, > - const struct dc_sink *sink, > - struct color_range *color_hue); > - > -bool mod_color_get_source_gamut(struct mod_color *mod_color, > - const struct dc_sink *sink, > - struct color_space_coordinates *source_gamut); > - > -bool mod_color_notify_mode_change(struct mod_color *mod_color, > - const struct dc_stream **streams, int num_streams); > - > -bool mod_color_set_brightness(struct mod_color *mod_color, > - const struct dc_stream **streams, int num_streams, > - int brightness_value); > - > -bool mod_color_set_contrast(struct mod_color *mod_color, > - const struct dc_stream **streams, int num_streams, > - int contrast_value); > - > -bool mod_color_set_hue(struct mod_color *mod_color, > - const struct dc_stream **streams, int num_streams, > - int hue_value); > - > -bool mod_color_set_saturation(struct mod_color *mod_color, > - const struct dc_stream **streams, int num_streams, > - int saturation_value); > - > -bool mod_color_set_input_gamma_correction(struct mod_color *mod_color, > - const struct dc_stream **streams, int num_streams, > - struct dc_gamma *gamma); > - > -bool mod_color_persist_user_preferred_quantization_range( > - struct mod_color *mod_color, > - const struct dc_sink *sink, > - enum dc_quantization_range quantization_range); > - > -bool mod_color_get_preferred_quantization_range(struct mod_color *mod_color, > - const struct dc_sink *sink, > - const struct dc_crtc_timing *timing, > - enum dc_quantization_range *quantization_range); > - > -bool mod_color_is_rgb_full_range_supported_for_timing( > - const struct dc_sink *sink, > - const struct dc_crtc_timing *timing); > - > -bool mod_color_is_rgb_limited_range_supported_for_timing( > - const struct dc_sink *sink, > - const struct dc_crtc_timing *timing); > - > -bool mod_color_set_regamma(struct mod_color *mod_color, > - const struct dc_stream **streams, int num_streams); > - > -bool mod_color_set_degamma(struct mod_color *mod_color, > - const struct dc_stream **streams, int num_streams, > - enum color_transfer_func transfer_function); > - > -bool mod_color_update_gamut_info(struct mod_color *mod_color, > - const struct dc_stream **streams, int num_streams); > - > -#endif /* MOD_COLOR_H_ */ > diff --git a/drivers/gpu/drm/amd/display/modules/inc/mod_power.h b/drivers/gpu/drm/amd/display/modules/inc/mod_power.h > deleted file mode 100644 > index a204e8d6cd23..000000000000 > --- a/drivers/gpu/drm/amd/display/modules/inc/mod_power.h > +++ /dev/null > @@ -1,112 +0,0 @@ > -/* > - * Copyright 2016 Advanced Micro Devices, Inc. > - * > - * Permission is hereby granted, free of charge, to any person obtaining a > - * copy of this software and associated documentation files (the "Software"), > - * to deal in the Software without restriction, including without limitation > - * the rights to use, copy, modify, merge, publish, distribute, sublicense, > - * and/or sell copies of the Software, and to permit persons to whom the > - * Software is furnished to do so, subject to the following conditions: > - * > - * The above copyright notice and this permission notice shall be included in > - * all copies or substantial portions of the Software. > - * > - * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR > - * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, > - * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL > - * THE COPYRIGHT HOLDER(S) OR AUTHOR(S) BE LIABLE FOR ANY CLAIM, DAMAGES OR > - * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, > - * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR > - * OTHER DEALINGS IN THE SOFTWARE. > - * > - * Authors: AMD > - * > - */ > - > -#ifndef MODULES_INC_MOD_POWER_H_ > -#define MODULES_INC_MOD_POWER_H_ > - > -#include "dm_services.h" > - > -struct mod_power { > - int dummy; > -}; > - > -/* VariBright related commands */ > -enum varibright_command { > - VariBright_Cmd__SetVBLevel = 0, > - VariBright_Cmd__UserEnable, > - VariBright_Cmd__PreDisplayConfigChange, > - VariBright_Cmd__PostDisplayConfigChange, > - VariBright_Cmd__SuspendABM, > - VariBright_Cmd__ResumeABM, > - > - VariBright_Cmd__Unknown, > -}; > - > -/* VariBright settings structure */ > -struct varibright_info { > - enum varibright_command cmd; > - > - unsigned int level; > - bool enable; > - bool activate; > -}; > - > -enum dmcu_block_psr_reason { > - /* This is a bitfield mask */ > - dmcu_block_psr_reason_invalid = 0x0, > - dmcu_block_psr_reason_vsync_int = 0x1, > - dmcu_block_psr_reason_shared_primary = 0x2, > - dmcu_block_psr_reason_unsupported_link_rate = 0x4 > -}; > - > -struct mod_power *mod_power_create(struct dc *dc); > - > -void mod_power_destroy(struct mod_power *mod_power); > - > -bool mod_power_add_sink(struct mod_power *mod_power, > - const struct dc_sink *sink); > - > -bool mod_power_remove_sink(struct mod_power *mod_power, > - const struct dc_sink *sink); > - > -bool mod_power_set_backlight(struct mod_power *mod_power, > - const struct dc_stream **streams, int num_streams, > - unsigned int backlight_8bit); > - > -bool mod_power_get_backlight(struct mod_power *mod_power, > - const struct dc_sink *sink, > - unsigned int *backlight_8bit); > - > -void mod_power_initialize_backlight_caps > - (struct mod_power *mod_power); > - > -unsigned int mod_power_backlight_level_percentage_to_signal > - (struct mod_power *mod_power, unsigned int percentage); > - > -unsigned int mod_power_backlight_level_signal_to_percentage > - (struct mod_power *mod_power, unsigned int signalLevel8bit); > - > -bool mod_power_get_panel_backlight_boundaries > - (struct mod_power *mod_power, > - unsigned int *min_backlight, > - unsigned int *max_backlight, > - unsigned int *output_ac_level_percentage, > - unsigned int *output_dc_level_percentage); > - > -bool mod_power_set_smooth_brightness(struct mod_power *mod_power, > - const struct dc_sink *sink, bool enable_brightness); > - > -bool mod_power_notify_mode_change(struct mod_power *mod_power, > - const struct dc_stream *stream); > - > -bool mod_power_varibright_control(struct mod_power *mod_power, > - struct varibright_info *input_varibright_info); > - > -bool mod_power_block_psr(bool block_enable, enum dmcu_block_psr_reason reason); > - > -bool mod_power_set_psr_enable(struct mod_power *mod_power, > - bool psr_enable); > - > -#endif /* MODULES_INC_MOD_POWER_H_ */ > diff --git a/drivers/gpu/drm/amd/display/modules/power/power.c b/drivers/gpu/drm/amd/display/modules/power/power.c > deleted file mode 100644 > index ea07e847da0a..000000000000 > --- a/drivers/gpu/drm/amd/display/modules/power/power.c > +++ /dev/null > @@ -1,784 +0,0 @@ > -/* > - * Copyright 2016 Advanced Micro Devices, Inc. > - * > - * Permission is hereby granted, free of charge, to any person obtaining a > - * copy of this software and associated documentation files (the "Software"), > - * to deal in the Software without restriction, including without limitation > - * the rights to use, copy, modify, merge, publish, distribute, sublicense, > - * and/or sell copies of the Software, and to permit persons to whom the > - * Software is furnished to do so, subject to the following conditions: > - * > - * The above copyright notice and this permission notice shall be included in > - * all copies or substantial portions of the Software. > - * > - * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR > - * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, > - * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL > - * THE COPYRIGHT HOLDER(S) OR AUTHOR(S) BE LIABLE FOR ANY CLAIM, DAMAGES OR > - * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, > - * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR > - * OTHER DEALINGS IN THE SOFTWARE. > - * > - * Authors: AMD > - * > - */ > - > -#include "mod_power.h" > -#include "dm_services.h" > -#include "dc.h" > -#include "core_types.h" > -#include "core_dc.h" > - > -#define MOD_POWER_MAX_CONCURRENT_SINKS 32 > -#define SMOOTH_BRIGHTNESS_ADJUSTMENT_TIME_IN_MS 500 > - > -struct sink_caps { > - const struct dc_sink *sink; > -}; > - > -struct backlight_state { > - unsigned int backlight; > - unsigned int frame_ramp; > - bool smooth_brightness_enabled; > -}; > - > -struct core_power { > - struct mod_power public; > - struct dc *dc; > - int num_sinks; > - struct sink_caps *caps; > - struct backlight_state *state; > -}; > - > -union dmcu_abm_set_bl_params { > - struct { > - unsigned int gradual_change : 1; /* [0:0] */ > - unsigned int reserved : 15; /* [15:1] */ > - unsigned int frame_ramp : 16; /* [31:16] */ > - } bits; > - unsigned int u32All; > -}; > - > -/* Backlight cached properties */ > -static unsigned int backlight_8bit_lut_array[101]; > -static unsigned int ac_level_percentage; > -static unsigned int dc_level_percentage; > -static bool backlight_caps_valid; > -/* we use lazy initialization of backlight capabilities cache */ > -static bool backlight_caps_initialized; > -/* AC/DC levels initialized later in separate context */ > -static bool backlight_def_levels_valid; > - > -/* ABM cached properties */ > -static unsigned int abm_level; > -static bool abm_user_enable; > -static bool abm_active; > - > -/*PSR cached properties*/ > -static unsigned int block_psr; > - > -/* Defines default backlight curve F(x) = A(x*x) + Bx + C. > - * > - * Backlight curve should always satisfy F(0) = min, F(100) = max, > - * so polynom coefficients are: > - * A is 0.0255 - B/100 - min/10000 - (255-max)/10000 = (max - min)/10000 - B/100 > - * B is adjustable factor to modify the curve. > - * Bigger B results in less concave curve. B range is [0..(max-min)/100] > - * C is backlight minimum > - */ > -static const unsigned int backlight_curve_coeff_a_factor = 10000; > -static const unsigned int backlight_curve_coeff_b = 100; > -static const unsigned int backlight_curve_coeff_b_factor = 100; > - > -/* Minimum and maximum backlight input signal levels */ > -static const unsigned int default_min_backlight = 12; > -static const unsigned int default_max_backlight = 255; > - > -/* Other backlight constants */ > -static const unsigned int absolute_backlight_max = 255; > - > -#define MOD_POWER_TO_CORE(mod_power)\ > - container_of(mod_power, struct core_power, public) > - > -static bool check_dc_support(const struct dc *dc) > -{ > - if (dc->stream_funcs.set_backlight == NULL) > - return false; > - > - return true; > -} > - > -/* Given a specific dc_sink* this function finds its equivalent > - * on the dc_sink array and returns the corresponding index > - */ > -static unsigned int sink_index_from_sink(struct core_power *core_power, > - const struct dc_sink *sink) > -{ > - unsigned int index = 0; > - > - for (index = 0; index < core_power->num_sinks; index++) > - if (core_power->caps[index].sink == sink) > - return index; > - > - /* Could not find sink requested */ > - ASSERT(false); > - return index; > -} > - > -static unsigned int convertBL8to17(unsigned int backlight_8bit) > -{ > - unsigned int temp_ulong = backlight_8bit * 0x10101; > - unsigned char temp_uchar = > - (unsigned char)(((temp_ulong & 0x80) >> 7) & 1); > - > - temp_ulong = (temp_ulong >> 8) + temp_uchar; > - > - return temp_ulong; > -} > - > -static uint16_t convertBL8to16(unsigned int backlight_8bit) > -{ > - return (uint16_t)((backlight_8bit * 0x10101) >> 8); > -} > - > -/*This is used when OS wants to retrieve the current BL. > - * We return the 8bit value to OS. > - */ > -static unsigned int convertBL17to8(unsigned int backlight_17bit) > -{ > - if (backlight_17bit & 0x10000) > - return default_max_backlight; > - else > - return (backlight_17bit >> 8); > -} > - > -struct mod_power *mod_power_create(struct dc *dc) > -{ > - struct core_power *core_power = > - dm_alloc(sizeof(struct core_power)); > - > - struct core_dc *core_dc = DC_TO_CORE(dc); > - > - int i = 0; > - > - if (core_power == NULL) > - goto fail_alloc_context; > - > - core_power->caps = dm_alloc(sizeof(struct sink_caps) * > - MOD_POWER_MAX_CONCURRENT_SINKS); > - > - if (core_power->caps == NULL) > - goto fail_alloc_caps; > - > - for (i = 0; i < MOD_POWER_MAX_CONCURRENT_SINKS; i++) > - core_power->caps[i].sink = NULL; > - > - core_power->state = dm_alloc(sizeof(struct backlight_state) * > - MOD_POWER_MAX_CONCURRENT_SINKS); > - > - if (core_power->state == NULL) > - goto fail_alloc_state; > - > - core_power->num_sinks = 0; > - backlight_caps_valid = false; > - > - if (dc == NULL) > - goto fail_construct; > - > - core_power->dc = dc; > - > - if (!check_dc_support(dc)) > - goto fail_construct; > - > - abm_user_enable = false; > - abm_active = false; > - > - return &core_power->public; > - > -fail_construct: > - dm_free(core_power->state); > - > -fail_alloc_state: > - dm_free(core_power->caps); > - > -fail_alloc_caps: > - dm_free(core_power); > - > -fail_alloc_context: > - return NULL; > -} > - > - > -void mod_power_destroy(struct mod_power *mod_power) > -{ > - if (mod_power != NULL) { > - int i; > - struct core_power *core_power = > - MOD_POWER_TO_CORE(mod_power); > - > - dm_free(core_power->state); > - > - for (i = 0; i < core_power->num_sinks; i++) > - dc_sink_release(core_power->caps[i].sink); > - > - dm_free(core_power->caps); > - > - dm_free(core_power); > - } > -} > - > -bool mod_power_add_sink(struct mod_power *mod_power, > - const struct dc_sink *sink) > -{ > - if (sink->sink_signal == SIGNAL_TYPE_VIRTUAL) > - return false; > - > - struct core_power *core_power = > - MOD_POWER_TO_CORE(mod_power); > - struct core_dc *core_dc = DC_TO_CORE(core_power->dc); > - > - if (core_power->num_sinks < MOD_POWER_MAX_CONCURRENT_SINKS) { > - dc_sink_retain(sink); > - core_power->caps[core_power->num_sinks].sink = sink; > - core_power->state[core_power->num_sinks]. > - smooth_brightness_enabled = false; > - core_power->state[core_power->num_sinks]. > - backlight = 100; > - core_power->num_sinks++; > - return true; > - } > - > - return false; > -} > - > -bool mod_power_remove_sink(struct mod_power *mod_power, > - const struct dc_sink *sink) > -{ > - int i = 0, j = 0; > - struct core_power *core_power = > - MOD_POWER_TO_CORE(mod_power); > - > - for (i = 0; i < core_power->num_sinks; i++) { > - if (core_power->caps[i].sink == sink) { > - /* To remove this sink, shift everything after down */ > - for (j = i; j < core_power->num_sinks - 1; j++) { > - core_power->caps[j].sink = > - core_power->caps[j + 1].sink; > - > - memcpy(&core_power->state[j], > - &core_power->state[j + 1], > - sizeof(struct backlight_state)); > - } > - core_power->num_sinks--; > - dc_sink_release(sink); > - return true; > - } > - } > - return false; > -} > - > -bool mod_power_set_backlight(struct mod_power *mod_power, > - const struct dc_stream **streams, int num_streams, > - unsigned int backlight_8bit) > -{ > - struct core_power *core_power = > - MOD_POWER_TO_CORE(mod_power); > - > - unsigned int frame_ramp = 0; > - > - unsigned int stream_index, sink_index, vsync_rate_hz; > - > - union dmcu_abm_set_bl_params params; > - > - for (stream_index = 0; stream_index < num_streams; stream_index++) { > - if (streams[stream_index]->sink->sink_signal == SIGNAL_TYPE_VIRTUAL) { > - core_power->state[sink_index].backlight = 0; > - core_power->state[sink_index].frame_ramp = 0; > - core_power->state[sink_index].smooth_brightness_enabled = false; > - continue; > - } > - > - sink_index = sink_index_from_sink(core_power, > - streams[stream_index]->sink); > - > - vsync_rate_hz = div64_u64(div64_u64((streams[stream_index]-> > - timing.pix_clk_khz * 1000), > - streams[stream_index]->timing.v_total), > - streams[stream_index]->timing.h_total); > - > - core_power->state[sink_index].backlight = backlight_8bit; > - > - if (core_power->state[sink_index].smooth_brightness_enabled) > - frame_ramp = ((vsync_rate_hz * > - SMOOTH_BRIGHTNESS_ADJUSTMENT_TIME_IN_MS) + 500) > - / 1000; > - else > - frame_ramp = 0; > - > - core_power->state[sink_index].frame_ramp = frame_ramp; > - } > - > - params.u32All = 0; > - params.bits.gradual_change = (frame_ramp > 0); > - params.bits.frame_ramp = frame_ramp; > - > - core_power->dc->stream_funcs.set_backlight > - (core_power->dc, backlight_8bit, params.u32All, streams[0]); > - > - return true; > -} > - > -bool mod_power_get_backlight(struct mod_power *mod_power, > - const struct dc_sink *sink, > - unsigned int *backlight_8bit) > -{ > - if (sink->sink_signal == SIGNAL_TYPE_VIRTUAL) > - return false; > - > - struct core_power *core_power = > - MOD_POWER_TO_CORE(mod_power); > - > - unsigned int sink_index = sink_index_from_sink(core_power, sink); > - > - *backlight_8bit = core_power->state[sink_index].backlight; > - > - return true; > -} > - > -/* hard coded to default backlight curve. */ > -void mod_power_initialize_backlight_caps(struct mod_power > - *mod_power) > -{ > - struct core_power *core_power = > - MOD_POWER_TO_CORE(mod_power); > - struct core_dc *core_dc = DC_TO_CORE(core_power->dc); > - unsigned int i; > - > - backlight_caps_initialized = true; > - > - struct dm_acpi_atif_backlight_caps *pExtCaps = NULL; > - bool customCurvePresent = false; > - bool customMinMaxPresent = false; > - bool customDefLevelsPresent = false; > - > - /* Allocate memory for ATIF output > - * (do not want to use 256 bytes on the stack) > - */ > - pExtCaps = (struct dm_acpi_atif_backlight_caps *) > - (dm_alloc(sizeof(struct dm_acpi_atif_backlight_caps))); > - if (pExtCaps == NULL) > - return; > - > - /* Retrieve ACPI extended brightness caps */ > - if (dm_query_extended_brightness_caps > - (core_dc->ctx, AcpiDisplayType_LCD1, pExtCaps)) { > - ac_level_percentage = pExtCaps->acLevelPercentage; > - dc_level_percentage = pExtCaps->dcLevelPercentage; > - customMinMaxPresent = true; > - customDefLevelsPresent = true; > - customCurvePresent = (pExtCaps->numOfDataPoints > 0); > - > - ASSERT(pExtCaps->numOfDataPoints <= 99); > - } else { > - dm_free(pExtCaps); > - return; > - } > - > - if (customMinMaxPresent) > - backlight_8bit_lut_array[0] = pExtCaps->minInputSignal; > - else > - backlight_8bit_lut_array[0] = default_min_backlight; > - > - if (customMinMaxPresent) > - backlight_8bit_lut_array[100] = pExtCaps->maxInputSignal; > - else > - backlight_8bit_lut_array[100] = default_max_backlight; > - > - ASSERT(backlight_8bit_lut_array[100] <= absolute_backlight_max); > - ASSERT(backlight_8bit_lut_array[0] <= > - backlight_8bit_lut_array[100]); > - > - /* Just to make sure we use valid values */ > - if (backlight_8bit_lut_array[100] > absolute_backlight_max) > - backlight_8bit_lut_array[100] = absolute_backlight_max; > - if (backlight_8bit_lut_array[0] > backlight_8bit_lut_array[100]) { > - unsigned int swap; > - > - swap = backlight_8bit_lut_array[0]; > - backlight_8bit_lut_array[0] = backlight_8bit_lut_array[100]; > - backlight_8bit_lut_array[100] = swap; > - } > - > - /* Build backlight translation table for custom curve */ > - if (customCurvePresent) { > - unsigned int index = 1; > - unsigned int numOfDataPoints = > - (pExtCaps->numOfDataPoints <= 99 ? > - pExtCaps->numOfDataPoints : 99); > - > - /* Filling translation table from data points - > - * between every two provided data points we > - * lineary interpolate missing values > - */ > - for (i = 0; i < numOfDataPoints; i++) { > - /* Clamp signal level between min and max > - * (since min and max might come other > - * soruce like registry) > - */ > - unsigned int luminance = > - pExtCaps->dataPoints[i].luminance; > - unsigned int signalLevel = > - pExtCaps->dataPoints[i].signalLevel; > - > - if (signalLevel < backlight_8bit_lut_array[0]) > - signalLevel = backlight_8bit_lut_array[0]; > - if (signalLevel > backlight_8bit_lut_array[100]) > - signalLevel = backlight_8bit_lut_array[100]; > - > - /* Lineary interpolate missing values */ > - if (index < luminance) { > - unsigned int baseValue = > - backlight_8bit_lut_array[index-1]; > - unsigned int deltaSignal = > - signalLevel - baseValue; > - unsigned int deltaLuma = > - luminance - index + 1; > - unsigned int step = deltaSignal; > - > - for (; index < luminance; index++) { > - backlight_8bit_lut_array[index] = > - baseValue + (step / deltaLuma); > - step += deltaSignal; > - } > - } > - > - /* Now [index == luminance], > - * so we can add data point to the translation table > - */ > - backlight_8bit_lut_array[index++] = signalLevel; > - } > - > - /* Complete the final segment of interpolation - > - * between last datapoint and maximum value > - */ > - if (index < 100) { > - unsigned int baseValue = > - backlight_8bit_lut_array[index-1]; > - unsigned int deltaSignal = > - backlight_8bit_lut_array[100] - > - baseValue; > - unsigned int deltaLuma = 100 - index + 1; > - unsigned int step = deltaSignal; > - > - for (; index < 100; index++) { > - backlight_8bit_lut_array[index] = > - baseValue + (step / deltaLuma); > - step += deltaSignal; > - } > - } > - /* Build backlight translation table based on default curve */ > - } else { > - unsigned int delta = > - backlight_8bit_lut_array[100] - > - backlight_8bit_lut_array[0]; > - unsigned int coeffC = backlight_8bit_lut_array[0]; > - unsigned int coeffB = > - (backlight_curve_coeff_b < delta ? > - backlight_curve_coeff_b : delta); > - unsigned int coeffA = delta - coeffB; /* coeffB is B*100 */ > - > - for (i = 1; i < 100; i++) { > - backlight_8bit_lut_array[i] = > - (coeffA * i * i) / > - backlight_curve_coeff_a_factor + > - (coeffB * i) / > - backlight_curve_coeff_b_factor + > - coeffC; > - } > - } > - > - if (pExtCaps != NULL) > - dm_free(pExtCaps); > - > - /* Successfully initialized */ > - backlight_caps_valid = true; > - backlight_def_levels_valid = customDefLevelsPresent; > -} > - > -unsigned int mod_power_backlight_level_percentage_to_signal( > - struct mod_power *mod_power, unsigned int percentage) > -{ > - /* Do lazy initialization of backlight capabilities*/ > - if (!backlight_caps_initialized) > - mod_power_initialize_backlight_caps(mod_power); > - > - /* Since the translation table is indexed by percentage, > - * we simply return backlight value at given percent > - */ > - if (backlight_caps_valid && percentage <= 100) > - return backlight_8bit_lut_array[percentage]; > - > - return -1; > -} > - > -unsigned int mod_power_backlight_level_signal_to_percentage( > - struct mod_power *mod_power, > - unsigned int signalLevel8bit) > -{ > - unsigned int invalid_backlight = (unsigned int)(-1); > - /* Do lazy initialization of backlight capabilities */ > - if (!backlight_caps_initialized) > - mod_power_initialize_backlight_caps(mod_power); > - > - /* If customer curve cannot convert to differentiated value near min > - * it is important to report 0 for min signal to pass setting "Dimmed" > - * setting in HCK brightness2 tests. > - */ > - if (signalLevel8bit <= backlight_8bit_lut_array[0]) > - return 0; > - > - /* Since the translation table is indexed by percentage > - * we need to do a binary search over the array > - * Another option would be to guess entry based on linear distribution > - * and then do linear search in correct direction > - */ > - if (backlight_caps_valid && signalLevel8bit <= > - absolute_backlight_max) { > - unsigned int min = 0; > - unsigned int max = 100; > - unsigned int mid = invalid_backlight; > - > - while (max >= min) { > - mid = (min + max) / 2; /* floor of half range */ > - > - if (backlight_8bit_lut_array[mid] < signalLevel8bit) > - min = mid + 1; > - else if (backlight_8bit_lut_array[mid] > > - signalLevel8bit) > - max = mid - 1; > - else > - break; > - > - if (max == 0 || max == 1) > - return invalid_backlight; > - } > - return mid; > - } > - > - return invalid_backlight; > -} > - > - > -bool mod_power_get_panel_backlight_boundaries( > - struct mod_power *mod_power, > - unsigned int *min_backlight, > - unsigned int *max_backlight, > - unsigned int *output_ac_level_percentage, > - unsigned int *output_dc_level_percentage) > -{ > - /* Do lazy initialization of backlight capabilities */ > - if (!backlight_caps_initialized) > - mod_power_initialize_backlight_caps(mod_power); > - > - /* If cache was successfully updated, > - * copy the values to output structure and return success > - */ > - if (backlight_caps_valid) { > - *min_backlight = backlight_8bit_lut_array[0]; > - *max_backlight = backlight_8bit_lut_array[100]; > - > - *output_ac_level_percentage = ac_level_percentage; > - *output_dc_level_percentage = dc_level_percentage; > - > - return true; > - } > - > - return false; > -} > - > -bool mod_power_set_smooth_brightness(struct mod_power *mod_power, > - const struct dc_sink *sink, bool enable_brightness) > -{ > - if (sink->sink_signal == SIGNAL_TYPE_VIRTUAL) > - return false; > - > - struct core_power *core_power = > - MOD_POWER_TO_CORE(mod_power); > - unsigned int sink_index = sink_index_from_sink(core_power, sink); > - > - core_power->state[sink_index].smooth_brightness_enabled > - = enable_brightness; > - return true; > -} > - > -bool mod_power_notify_mode_change(struct mod_power *mod_power, > - const struct dc_stream *stream) > -{ > - if (stream->sink->sink_signal == SIGNAL_TYPE_VIRTUAL) > - return false; > - > - struct core_power *core_power = > - MOD_POWER_TO_CORE(mod_power); > - > - unsigned int sink_index = sink_index_from_sink(core_power, > - stream->sink); > - unsigned int frame_ramp = core_power->state[sink_index].frame_ramp; > - union dmcu_abm_set_bl_params params; > - > - params.u32All = 0; > - params.bits.gradual_change = (frame_ramp > 0); > - params.bits.frame_ramp = frame_ramp; > - > - core_power->dc->stream_funcs.set_backlight > - (core_power->dc, > - core_power->state[sink_index].backlight, > - params.u32All, stream); > - > - core_power->dc->stream_funcs.setup_psr > - (core_power->dc, stream); > - > - return true; > -} > - > - > -static bool mod_power_abm_feature_enable(struct mod_power > - *mod_power, bool enable) > -{ > - struct core_power *core_power = > - MOD_POWER_TO_CORE(mod_power); > - if (abm_user_enable == enable) > - return true; > - > - abm_user_enable = enable; > - > - if (enable) { > - if (abm_level != 0 && abm_active) > - core_power->dc->stream_funcs.set_abm_level > - (core_power->dc, abm_level); > - } else { > - if (abm_level != 0 && abm_active) { > - abm_level = 0; > - core_power->dc->stream_funcs.set_abm_level > - (core_power->dc, abm_level); > - } > - } > - > - return true; > -} > - > -static bool mod_power_abm_activate(struct mod_power > - *mod_power, bool activate) > -{ > - struct core_power *core_power = > - MOD_POWER_TO_CORE(mod_power); > - if (abm_active == activate) > - return true; > - > - abm_active = activate; > - > - if (activate) { > - if (abm_level != 0 && abm_user_enable) > - core_power->dc->stream_funcs.set_abm_level > - (core_power->dc, abm_level); > - } else { > - if (abm_level != 0 && abm_user_enable) { > - abm_level = 0; > - core_power->dc->stream_funcs.set_abm_level > - (core_power->dc, abm_level); > - } > - } > - > - return true; > -} > - > -static bool mod_power_abm_set_level(struct mod_power *mod_power, > - unsigned int level) > -{ > - struct core_power *core_power = > - MOD_POWER_TO_CORE(mod_power); > - if (abm_level == level) > - return true; > - > - if (abm_active && abm_user_enable && level == 0) > - core_power->dc->stream_funcs.set_abm_level > - (core_power->dc, 0); > - else if (abm_active && abm_user_enable && level != 0) > - core_power->dc->stream_funcs.set_abm_level > - (core_power->dc, level); > - > - abm_level = level; > - > - return true; > -} > - > -bool mod_power_varibright_control(struct mod_power *mod_power, > - struct varibright_info *input_varibright_info) > -{ > - switch (input_varibright_info->cmd) { > - case VariBright_Cmd__SetVBLevel: > - { > - /* Set VariBright user level. */ > - mod_power_abm_set_level(mod_power, > - input_varibright_info->level); > - } > - break; > - > - case VariBright_Cmd__UserEnable: > - { > - /* Set VariBright user enable state. */ > - mod_power_abm_feature_enable(mod_power, > - input_varibright_info->enable); > - } > - break; > - > - case VariBright_Cmd__PostDisplayConfigChange: > - { > - /* Set VariBright user level. */ > - mod_power_abm_set_level(mod_power, > - input_varibright_info->level); > - > - /* Set VariBright user enable state. */ > - mod_power_abm_feature_enable(mod_power, > - input_varibright_info->enable); > - > - /* Set VariBright activate based on power state. */ > - mod_power_abm_activate(mod_power, > - input_varibright_info->activate); > - } > - break; > - > - default: > - { > - return false; > - } > - break; > - } > - > - return true; > -} > - > -bool mod_power_block_psr(bool block_enable, enum dmcu_block_psr_reason reason) > -{ > - if (block_enable) > - block_psr |= reason; > - else > - block_psr &= ~reason; > - > - return true; > -} > - > - > -bool mod_power_set_psr_enable(struct mod_power *mod_power, > - bool psr_enable) > -{ > - struct core_power *core_power = > - MOD_POWER_TO_CORE(mod_power); > - > - if (block_psr == 0) > - return core_power->dc->stream_funcs.set_psr_enable > - (core_power->dc, psr_enable); > - > - return false; > -} > - > - > -- > 2.9.3 > > _______________________________________________ > amd-gfx mailing list > amd-gfx at lists.freedesktop.org > https://lists.freedesktop.org/mailman/listinfo/amd-gfx