#include "dm_services.h"
#include "dce110_transform_v.h"
#include "basics/conversion.h"
#include "dce/dce_11_0_d.h"
#include "dce/dce_11_0_sh_mask.h"
#include "dce/dce_11_0_enum.h"
enum {
OUTPUT_CSC_MATRIX_SIZE = 12
};
#define UNDERLAY_CONTRAST_DEFAULT 100
#define UNDERLAY_CONTRAST_MAX 200
#define UNDERLAY_CONTRAST_MIN 0
#define UNDERLAY_CONTRAST_STEP 1
#define UNDERLAY_CONTRAST_DIVIDER 100
#define UNDERLAY_SATURATION_DEFAULT 100 /*1.00*/
#define UNDERLAY_SATURATION_MIN 0
#define UNDERLAY_SATURATION_MAX 200 /* 2.00 */
#define UNDERLAY_SATURATION_STEP 1 /* 0.01 */
#define UNDERLAY_HUE_DEFAULT 0
#define UNDERLAY_HUE_MIN -300
#define UNDERLAY_HUE_MAX 300
#define UNDERLAY_HUE_STEP 5
#define UNDERLAY_HUE_DIVIDER 10 /* HW range: -30 ~ +30 */
#define UNDERLAY_SATURATION_DIVIDER 100
#define UNDERLAY_BRIGHTNESS_DEFAULT 0
#define UNDERLAY_BRIGHTNESS_MIN -46 /* ~116/255 */
#define UNDERLAY_BRIGHTNESS_MAX 46
#define UNDERLAY_BRIGHTNESS_STEP 1 /* .01 */
#define UNDERLAY_BRIGHTNESS_DIVIDER 100
static const struct out_csc_color_matrix global_color_matrix[] = {
{ COLOR_SPACE_SRGB,
{ 0x2000, 0, 0, 0, 0, 0x2000, 0, 0, 0, 0, 0x2000, 0} },
{ COLOR_SPACE_SRGB_LIMITED,
{ 0x1B60, 0, 0, 0x200, 0, 0x1B60, 0, 0x200, 0, 0, 0x1B60, 0x200} },
{ COLOR_SPACE_YCBCR601,
{ 0xE00, 0xF447, 0xFDB9, 0x1000, 0x82F, 0x1012, 0x31F, 0x200, 0xFB47,
0xF6B9, 0xE00, 0x1000} },
{ COLOR_SPACE_YCBCR709, { 0xE00, 0xF349, 0xFEB7, 0x1000, 0x5D2, 0x1394, 0x1FA,
0x200, 0xFCCB, 0xF535, 0xE00, 0x1000} },
{ COLOR_SPACE_YCBCR601_LIMITED, { 0xE00, 0xF447, 0xFDB9, 0x1000, 0x991,
0x12C9, 0x3A6, 0x200, 0xFB47, 0xF6B9, 0xE00, 0x1000} },
{ COLOR_SPACE_YCBCR709_LIMITED, { 0xE00, 0xF349, 0xFEB7, 0x1000, 0x6CE, 0x16E3,
0x24F, 0x200, 0xFCCB, 0xF535, 0xE00, 0x1000} }
};
enum csc_color_mode {
CSC_COLOR_MODE_GRAPHICS_BYPASS,
CSC_COLOR_MODE_GRAPHICS_PREDEFINED,
CSC_COLOR_MODE_GRAPHICS_OUTPUT_CSC,
};
enum grph_color_adjust_option {
GRPH_COLOR_MATRIX_HW_DEFAULT = 1,
GRPH_COLOR_MATRIX_SW
};
static void program_color_matrix_v(
struct dce_transform *xfm_dce,
const struct out_csc_color_matrix *tbl_entry,
enum grph_color_adjust_option options)
{
struct dc_context *ctx = xfm_dce->base.ctx;
uint32_t cntl_value = dm_read_reg(ctx, mmCOL_MAN_OUTPUT_CSC_CONTROL);
bool use_set_a = (get_reg_field_value(cntl_value,
COL_MAN_OUTPUT_CSC_CONTROL,
OUTPUT_CSC_MODE) != 4);
set_reg_field_value(
cntl_value,
0,
COL_MAN_OUTPUT_CSC_CONTROL,
OUTPUT_CSC_MODE);
if (use_set_a) {
{
uint32_t value = 0;
uint32_t addr = mmOUTPUT_CSC_C11_C12_A;
set_reg_field_value(
value,
tbl_entry->regval[0],
OUTPUT_CSC_C11_C12_A,
OUTPUT_CSC_C11_A);
set_reg_field_value(
value,
tbl_entry->regval[1],
OUTPUT_CSC_C11_C12_A,
OUTPUT_CSC_C12_A);
dm_write_reg(ctx, addr, value);
}
{
uint32_t value = 0;
uint32_t addr = mmOUTPUT_CSC_C13_C14_A;
set_reg_field_value(
value,
tbl_entry->regval[2],
OUTPUT_CSC_C13_C14_A,
OUTPUT_CSC_C13_A);
set_reg_field_value(
value,
tbl_entry->regval[3],
OUTPUT_CSC_C13_C14_A,
OUTPUT_CSC_C14_A);
dm_write_reg(ctx, addr, value);
}
{
uint32_t value = 0;
uint32_t addr = mmOUTPUT_CSC_C21_C22_A;
set_reg_field_value(
value,
tbl_entry->regval[4],
OUTPUT_CSC_C21_C22_A,
OUTPUT_CSC_C21_A);
set_reg_field_value(
value,
tbl_entry->regval[5],
OUTPUT_CSC_C21_C22_A,
OUTPUT_CSC_C22_A);
dm_write_reg(ctx, addr, value);
}
{
uint32_t value = 0;
uint32_t addr = mmOUTPUT_CSC_C23_C24_A;
set_reg_field_value(
value,
tbl_entry->regval[6],
OUTPUT_CSC_C23_C24_A,
OUTPUT_CSC_C23_A);
set_reg_field_value(
value,
tbl_entry->regval[7],
OUTPUT_CSC_C23_C24_A,
OUTPUT_CSC_C24_A);
dm_write_reg(ctx, addr, value);
}
{
uint32_t value = 0;
uint32_t addr = mmOUTPUT_CSC_C31_C32_A;
set_reg_field_value(
value,
tbl_entry->regval[8],
OUTPUT_CSC_C31_C32_A,
OUTPUT_CSC_C31_A);
set_reg_field_value(
value,
tbl_entry->regval[9],
OUTPUT_CSC_C31_C32_A,
OUTPUT_CSC_C32_A);
dm_write_reg(ctx, addr, value);
}
{
uint32_t value = 0;
uint32_t addr = mmOUTPUT_CSC_C33_C34_A;
set_reg_field_value(
value,
tbl_entry->regval[10],
OUTPUT_CSC_C33_C34_A,
OUTPUT_CSC_C33_A);
set_reg_field_value(
value,
tbl_entry->regval[11],
OUTPUT_CSC_C33_C34_A,
OUTPUT_CSC_C34_A);
dm_write_reg(ctx, addr, value);
}
set_reg_field_value(
cntl_value,
4,
COL_MAN_OUTPUT_CSC_CONTROL,
OUTPUT_CSC_MODE);
} else {
{
uint32_t value = 0;
uint32_t addr = mmOUTPUT_CSC_C11_C12_B;
set_reg_field_value(
value,
tbl_entry->regval[0],
OUTPUT_CSC_C11_C12_B,
OUTPUT_CSC_C11_B);
set_reg_field_value(
value,
tbl_entry->regval[1],
OUTPUT_CSC_C11_C12_B,
OUTPUT_CSC_C12_B);
dm_write_reg(ctx, addr, value);
}
{
uint32_t value = 0;
uint32_t addr = mmOUTPUT_CSC_C13_C14_B;
set_reg_field_value(
value,
tbl_entry->regval[2],
OUTPUT_CSC_C13_C14_B,
OUTPUT_CSC_C13_B);
set_reg_field_value(
value,
tbl_entry->regval[3],
OUTPUT_CSC_C13_C14_B,
OUTPUT_CSC_C14_B);
dm_write_reg(ctx, addr, value);
}
{
uint32_t value = 0;
uint32_t addr = mmOUTPUT_CSC_C21_C22_B;
set_reg_field_value(
value,
tbl_entry->regval[4],
OUTPUT_CSC_C21_C22_B,
OUTPUT_CSC_C21_B);
set_reg_field_value(
value,
tbl_entry->regval[5],
OUTPUT_CSC_C21_C22_B,
OUTPUT_CSC_C22_B);
dm_write_reg(ctx, addr, value);
}
{
uint32_t value = 0;
uint32_t addr = mmOUTPUT_CSC_C23_C24_B;
set_reg_field_value(
value,
tbl_entry->regval[6],
OUTPUT_CSC_C23_C24_B,
OUTPUT_CSC_C23_B);
set_reg_field_value(
value,
tbl_entry->regval[7],
OUTPUT_CSC_C23_C24_B,
OUTPUT_CSC_C24_B);
dm_write_reg(ctx, addr, value);
}
{
uint32_t value = 0;
uint32_t addr = mmOUTPUT_CSC_C31_C32_B;
set_reg_field_value(
value,
tbl_entry->regval[8],
OUTPUT_CSC_C31_C32_B,
OUTPUT_CSC_C31_B);
set_reg_field_value(
value,
tbl_entry->regval[9],
OUTPUT_CSC_C31_C32_B,
OUTPUT_CSC_C32_B);
dm_write_reg(ctx, addr, value);
}
{
uint32_t value = 0;
uint32_t addr = mmOUTPUT_CSC_C33_C34_B;
set_reg_field_value(
value,
tbl_entry->regval[10],
OUTPUT_CSC_C33_C34_B,
OUTPUT_CSC_C33_B);
set_reg_field_value(
value,
tbl_entry->regval[11],
OUTPUT_CSC_C33_C34_B,
OUTPUT_CSC_C34_B);
dm_write_reg(ctx, addr, value);
}
set_reg_field_value(
cntl_value,
5,
COL_MAN_OUTPUT_CSC_CONTROL,
OUTPUT_CSC_MODE);
}
dm_write_reg(ctx, mmCOL_MAN_OUTPUT_CSC_CONTROL, cntl_value);
}
static bool configure_graphics_mode_v(
struct dce_transform *xfm_dce,
enum csc_color_mode config,
enum graphics_csc_adjust_type csc_adjust_type,
enum dc_color_space color_space)
{
struct dc_context *ctx = xfm_dce->base.ctx;
uint32_t addr = mmCOL_MAN_OUTPUT_CSC_CONTROL;
uint32_t value = dm_read_reg(ctx, addr);
set_reg_field_value(
value,
0,
COL_MAN_OUTPUT_CSC_CONTROL,
OUTPUT_CSC_MODE);
if (csc_adjust_type == GRAPHICS_CSC_ADJUST_TYPE_SW) {
if (config == CSC_COLOR_MODE_GRAPHICS_OUTPUT_CSC)
return true;
switch (color_space) {
case COLOR_SPACE_SRGB:
set_reg_field_value(
value,
0,
COL_MAN_OUTPUT_CSC_CONTROL,
OUTPUT_CSC_MODE);
break;
case COLOR_SPACE_SRGB_LIMITED:
return false;
case COLOR_SPACE_YCBCR601_LIMITED:
set_reg_field_value(
value,
2,
COL_MAN_OUTPUT_CSC_CONTROL,
OUTPUT_CSC_MODE);
break;
case COLOR_SPACE_YCBCR709:
case COLOR_SPACE_YCBCR709_LIMITED:
set_reg_field_value(
value,
3,
COL_MAN_OUTPUT_CSC_CONTROL,
OUTPUT_CSC_MODE);
break;
default:
return false;
}
} else if (csc_adjust_type == GRAPHICS_CSC_ADJUST_TYPE_HW) {
switch (color_space) {
case COLOR_SPACE_SRGB:
set_reg_field_value(
value,
0,
COL_MAN_OUTPUT_CSC_CONTROL,
OUTPUT_CSC_MODE);
break;
case COLOR_SPACE_SRGB_LIMITED:
return false;
case COLOR_SPACE_YCBCR601:
case COLOR_SPACE_YCBCR601_LIMITED:
set_reg_field_value(
value,
2,
COL_MAN_OUTPUT_CSC_CONTROL,
OUTPUT_CSC_MODE);
break;
case COLOR_SPACE_YCBCR709:
case COLOR_SPACE_YCBCR709_LIMITED:
set_reg_field_value(
value,
3,
COL_MAN_OUTPUT_CSC_CONTROL,
OUTPUT_CSC_MODE);
break;
default:
return false;
}
} else
set_reg_field_value(
value,
0,
COL_MAN_OUTPUT_CSC_CONTROL,
OUTPUT_CSC_MODE);
addr = mmCOL_MAN_OUTPUT_CSC_CONTROL;
dm_write_reg(ctx, addr, value);
return true;
}
static void set_Denormalization(struct transform *xfm,
enum dc_color_depth color_depth)
{
uint32_t value = dm_read_reg(xfm->ctx, mmDENORM_CLAMP_CONTROL);
switch (color_depth) {
case COLOR_DEPTH_888:
set_reg_field_value(
value,
1,
DENORM_CLAMP_CONTROL,
DENORM_MODE);
break;
case COLOR_DEPTH_101010:
set_reg_field_value(
value,
2,
DENORM_CLAMP_CONTROL,
DENORM_MODE);
break;
case COLOR_DEPTH_121212:
set_reg_field_value(
value,
3,
DENORM_CLAMP_CONTROL,
DENORM_MODE);
break;
default:
break;
}
set_reg_field_value(
value,
1,
DENORM_CLAMP_CONTROL,
DENORM_10BIT_OUT);
dm_write_reg(xfm->ctx, mmDENORM_CLAMP_CONTROL, value);
}
struct input_csc_matrix {
enum dc_color_space color_space;
uint32_t regval[12];
};
static const struct input_csc_matrix input_csc_matrix[] = {
{COLOR_SPACE_SRGB,
{0x2000, 0, 0, 0, 0, 0x2000, 0, 0, 0, 0, 0x2000, 0} },
{COLOR_SPACE_SRGB_LIMITED,
{0x2000, 0, 0, 0, 0, 0x2000, 0, 0, 0, 0, 0x2000, 0} },
{COLOR_SPACE_YCBCR601,
{0x2cdd, 0x2000, 0x0, 0xe991, 0xe926, 0x2000, 0xf4fd, 0x10ef,
0x0, 0x2000, 0x38b4, 0xe3a6} },
{COLOR_SPACE_YCBCR601_LIMITED,
{0x3353, 0x2568, 0x0, 0xe400, 0xe5dc, 0x2568, 0xf367, 0x1108,
0x0, 0x2568, 0x40de, 0xdd3a} },
{COLOR_SPACE_YCBCR709,
{0x3265, 0x2000, 0, 0xe6ce, 0xf105, 0x2000, 0xfa01, 0xa7d, 0,
0x2000, 0x3b61, 0xe24f} },
{COLOR_SPACE_YCBCR709_LIMITED,
{0x39a6, 0x2568, 0, 0xe0d6, 0xeedd, 0x2568, 0xf925, 0x9a8, 0,
0x2568, 0x43ee, 0xdbb2} }
};
static void program_input_csc(
struct transform *xfm, enum dc_color_space color_space)
{
int arr_size = sizeof(input_csc_matrix)/sizeof(struct input_csc_matrix);
struct dc_context *ctx = xfm->ctx;
const uint32_t *regval = NULL;
bool use_set_a;
uint32_t value;
int i;
for (i = 0; i < arr_size; i++)
if (input_csc_matrix[i].color_space == color_space) {
regval = input_csc_matrix[i].regval;
break;
}
if (regval == NULL) {
BREAK_TO_DEBUGGER();
return;
}
value = dm_read_reg(ctx, mmCOL_MAN_INPUT_CSC_CONTROL);
use_set_a = get_reg_field_value(
value, COL_MAN_INPUT_CSC_CONTROL, INPUT_CSC_MODE) != 1;
if (use_set_a) {
value = 0;
set_reg_field_value(
value, regval[0], INPUT_CSC_C11_C12_A, INPUT_CSC_C11_A);
set_reg_field_value(
value, regval[1], INPUT_CSC_C11_C12_A, INPUT_CSC_C12_A);
dm_write_reg(ctx, mmINPUT_CSC_C11_C12_A, value);
value = 0;
set_reg_field_value(
value, regval[2], INPUT_CSC_C13_C14_A, INPUT_CSC_C13_A);
set_reg_field_value(
value, regval[3], INPUT_CSC_C13_C14_A, INPUT_CSC_C14_A);
dm_write_reg(ctx, mmINPUT_CSC_C13_C14_A, value);
value = 0;
set_reg_field_value(
value, regval[4], INPUT_CSC_C21_C22_A, INPUT_CSC_C21_A);
set_reg_field_value(
value, regval[5], INPUT_CSC_C21_C22_A, INPUT_CSC_C22_A);
dm_write_reg(ctx, mmINPUT_CSC_C21_C22_A, value);
value = 0;
set_reg_field_value(
value, regval[6], INPUT_CSC_C23_C24_A, INPUT_CSC_C23_A);
set_reg_field_value(
value, regval[7], INPUT_CSC_C23_C24_A, INPUT_CSC_C24_A);
dm_write_reg(ctx, mmINPUT_CSC_C23_C24_A, value);
value = 0;
set_reg_field_value(
value, regval[8], INPUT_CSC_C31_C32_A, INPUT_CSC_C31_A);
set_reg_field_value(
value, regval[9], INPUT_CSC_C31_C32_A, INPUT_CSC_C32_A);
dm_write_reg(ctx, mmINPUT_CSC_C31_C32_A, value);
value = 0;
set_reg_field_value(
value, regval[10], INPUT_CSC_C33_C34_A, INPUT_CSC_C33_A);
set_reg_field_value(
value, regval[11], INPUT_CSC_C33_C34_A, INPUT_CSC_C34_A);
dm_write_reg(ctx, mmINPUT_CSC_C33_C34_A, value);
} else {
value = 0;
set_reg_field_value(
value, regval[0], INPUT_CSC_C11_C12_B, INPUT_CSC_C11_B);
set_reg_field_value(
value, regval[1], INPUT_CSC_C11_C12_B, INPUT_CSC_C12_B);
dm_write_reg(ctx, mmINPUT_CSC_C11_C12_B, value);
value = 0;
set_reg_field_value(
value, regval[2], INPUT_CSC_C13_C14_B, INPUT_CSC_C13_B);
set_reg_field_value(
value, regval[3], INPUT_CSC_C13_C14_B, INPUT_CSC_C14_B);
dm_write_reg(ctx, mmINPUT_CSC_C13_C14_B, value);
value = 0;
set_reg_field_value(
value, regval[4], INPUT_CSC_C21_C22_B, INPUT_CSC_C21_B);
set_reg_field_value(
value, regval[5], INPUT_CSC_C21_C22_B, INPUT_CSC_C22_B);
dm_write_reg(ctx, mmINPUT_CSC_C21_C22_B, value);
value = 0;
set_reg_field_value(
value, regval[6], INPUT_CSC_C23_C24_B, INPUT_CSC_C23_B);
set_reg_field_value(
value, regval[7], INPUT_CSC_C23_C24_B, INPUT_CSC_C24_B);
dm_write_reg(ctx, mmINPUT_CSC_C23_C24_B, value);
value = 0;
set_reg_field_value(
value, regval[8], INPUT_CSC_C31_C32_B, INPUT_CSC_C31_B);
set_reg_field_value(
value, regval[9], INPUT_CSC_C31_C32_B, INPUT_CSC_C32_B);
dm_write_reg(ctx, mmINPUT_CSC_C31_C32_B, value);
value = 0;
set_reg_field_value(
value, regval[10], INPUT_CSC_C33_C34_B, INPUT_CSC_C33_B);
set_reg_field_value(
value, regval[11], INPUT_CSC_C33_C34_B, INPUT_CSC_C34_B);
dm_write_reg(ctx, mmINPUT_CSC_C33_C34_B, value);
}
value = 0;
set_reg_field_value(
value, 2, COL_MAN_INPUT_CSC_CONTROL, INPUT_CSC_INPUT_TYPE);
set_reg_field_value(
value,
use_set_a ? 1 : 2,
COL_MAN_INPUT_CSC_CONTROL,
INPUT_CSC_MODE);
dm_write_reg(ctx, mmCOL_MAN_INPUT_CSC_CONTROL, value);
}
void dce110_opp_v_set_csc_default(
struct transform *xfm,
const struct default_adjustment *default_adjust)
{
struct dce_transform *xfm_dce = TO_DCE_TRANSFORM(xfm);
enum csc_color_mode config =
CSC_COLOR_MODE_GRAPHICS_PREDEFINED;
if (default_adjust->force_hw_default == false) {
const struct out_csc_color_matrix *elm;
enum grph_color_adjust_option option;
uint32_t i;
option = GRPH_COLOR_MATRIX_SW;
for (i = 0; i < ARRAY_SIZE(global_color_matrix); ++i) {
elm = &global_color_matrix[i];
if (elm->color_space != default_adjust->out_color_space)
continue;
program_color_matrix_v(xfm_dce, elm, option);
config = CSC_COLOR_MODE_GRAPHICS_OUTPUT_CSC;
break;
}
}
program_input_csc(xfm, default_adjust->in_color_space);
configure_graphics_mode_v(xfm_dce, config,
default_adjust->csc_adjust_type,
default_adjust->out_color_space);
set_Denormalization(xfm, default_adjust->color_depth);
}
void dce110_opp_v_set_csc_adjustment(
struct transform *xfm,
const struct out_csc_color_matrix *tbl_entry)
{
struct dce_transform *xfm_dce = TO_DCE_TRANSFORM(xfm);
enum csc_color_mode config =
CSC_COLOR_MODE_GRAPHICS_OUTPUT_CSC;
program_color_matrix_v(
xfm_dce, tbl_entry, GRPH_COLOR_MATRIX_SW);
configure_graphics_mode_v(xfm_dce, config, GRAPHICS_CSC_ADJUST_TYPE_SW,
tbl_entry->color_space);
}