+++ /dev/null
-/*
- * 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;
-}
+++ /dev/null
-/*
- * 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;
-}
-
-
projects / openwrt / staging / blogic.git / commitdiff