drivers/gpu/drm/amd/display/dc/dce110/dce110_opp_regamma_v.c

   1 /*
   2  * Copyright 2012-15 Advanced Micro Devices, Inc.
   3  *
   4  * Permission is hereby granted, free of charge, to any person obtaining a
   5  * copy of this software and associated documentation files (the "Software"),
   6  * to deal in the Software without restriction, including without limitation
   7  * the rights to use, copy, modify, merge, publish, distribute, sublicense,
   8  * and/or sell copies of the Software, and to permit persons to whom the
   9  * Software is furnished to do so, subject to the following conditions:
  10  *
  11  * The above copyright notice and this permission notice shall be included in
  12  * all copies or substantial portions of the Software.
  13  *
  14  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
  15  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
  16  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL
  17  * THE COPYRIGHT HOLDER(S) OR AUTHOR(S) BE LIABLE FOR ANY CLAIM, DAMAGES OR
  18  * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
  19  * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
  20  * OTHER DEALINGS IN THE SOFTWARE.
  21  *
  22  * Authors: AMD
  23  *
  24  */
  25
  26 #include <linux/delay.h>
  27
  28 #include "dm_services.h"
  29
  30 /* include DCE11 register header files */
  31 #include "dce/dce_11_0_d.h"
  32 #include "dce/dce_11_0_sh_mask.h"
  33
  34 #include "dce110_transform_v.h"
  35
  36 static void power_on_lut(struct transform *xfm,
  37         bool power_on, bool inputgamma, bool regamma)
  38 {
  39         uint32_t value = dm_read_reg(xfm->ctx, mmDCFEV_MEM_PWR_CTRL);
  40         int i;
  41
  42         if (power_on) {
  43                 if (inputgamma)
  44                         set_reg_field_value(
  45                                 value,
  46                                 1,
  47                                 DCFEV_MEM_PWR_CTRL,
  48                                 COL_MAN_INPUT_GAMMA_MEM_PWR_DIS);
  49                 if (regamma)
  50                         set_reg_field_value(
  51                                 value,
  52                                 1,
  53                                 DCFEV_MEM_PWR_CTRL,
  54                                 COL_MAN_GAMMA_CORR_MEM_PWR_DIS);
  55         } else {
  56                 if (inputgamma)
  57                         set_reg_field_value(
  58                                 value,
  59                                 0,
  60                                 DCFEV_MEM_PWR_CTRL,
  61                                 COL_MAN_INPUT_GAMMA_MEM_PWR_DIS);
  62                 if (regamma)
  63                         set_reg_field_value(
  64                                 value,
  65                                 0,
  66                                 DCFEV_MEM_PWR_CTRL,
  67                                 COL_MAN_GAMMA_CORR_MEM_PWR_DIS);
  68         }
  69
  70         dm_write_reg(xfm->ctx, mmDCFEV_MEM_PWR_CTRL, value);
  71
  72         for (i = 0; i < 3; i++) {
  73                 value = dm_read_reg(xfm->ctx, mmDCFEV_MEM_PWR_CTRL);
  74                 if (get_reg_field_value(value,
  75                                 DCFEV_MEM_PWR_CTRL,
  76                                 COL_MAN_INPUT_GAMMA_MEM_PWR_DIS) &&
  77                         get_reg_field_value(value,
  78                                         DCFEV_MEM_PWR_CTRL,
  79                                         COL_MAN_GAMMA_CORR_MEM_PWR_DIS))
  80                         break;
  81
  82                 udelay(2);
  83         }
  84 }
  85
  86 static void set_bypass_input_gamma(struct dce_transform *xfm_dce)
  87 {
  88         uint32_t value;
  89
  90         value = dm_read_reg(xfm_dce->base.ctx,
  91                         mmCOL_MAN_INPUT_GAMMA_CONTROL1);
  92
  93         set_reg_field_value(
  94                                 value,
  95                                 0,
  96                                 COL_MAN_INPUT_GAMMA_CONTROL1,
  97                                 INPUT_GAMMA_MODE);
  98
  99         dm_write_reg(xfm_dce->base.ctx,
 100                         mmCOL_MAN_INPUT_GAMMA_CONTROL1, value);
 101 }
 102
 103 static void configure_regamma_mode(struct dce_transform *xfm_dce, uint32_t mode)
 104 {
 105         uint32_t value = 0;
 106
 107         set_reg_field_value(
 108                                 value,
 109                                 mode,
 110                                 GAMMA_CORR_CONTROL,
 111                                 GAMMA_CORR_MODE);
 112
 113         dm_write_reg(xfm_dce->base.ctx, mmGAMMA_CORR_CONTROL, 0);
 114 }
 115
 116 /*
 117  *****************************************************************************
 118  *  Function: regamma_config_regions_and_segments
 119  *
 120  *     build regamma curve by using predefined hw points
 121  *     uses interface parameters ,like EDID coeff.
 122  *
 123  * @param   : parameters   interface parameters
 124  *  @return void
 125  *
 126  *  @note
 127  *
 128  *  @see
 129  *
 130  *****************************************************************************
 131  */
 132 static void regamma_config_regions_and_segments(
 133         struct dce_transform *xfm_dce, const struct pwl_params *params)
 134 {
 135         const struct gamma_curve *curve;
 136         uint32_t value = 0;
 137
 138         {
 139                 set_reg_field_value(
 140                         value,
 141                         params->arr_points[0].custom_float_x,
 142                         GAMMA_CORR_CNTLA_START_CNTL,
 143                         GAMMA_CORR_CNTLA_EXP_REGION_START);
 144
 145                 set_reg_field_value(
 146                         value,
 147                         0,
 148                         GAMMA_CORR_CNTLA_START_CNTL,
 149                         GAMMA_CORR_CNTLA_EXP_REGION_START_SEGMENT);
 150
 151                 dm_write_reg(xfm_dce->base.ctx, mmGAMMA_CORR_CNTLA_START_CNTL,
 152                                 value);
 153         }
 154         {
 155                 value = 0;
 156                 set_reg_field_value(
 157                         value,
 158                         params->arr_points[0].custom_float_slope,
 159                         GAMMA_CORR_CNTLA_SLOPE_CNTL,
 160                         GAMMA_CORR_CNTLA_EXP_REGION_LINEAR_SLOPE);
 161
 162                 dm_write_reg(xfm_dce->base.ctx,
 163                         mmGAMMA_CORR_CNTLA_SLOPE_CNTL, value);
 164         }
 165         {
 166                 value = 0;
 167                 set_reg_field_value(
 168                         value,
 169                         params->arr_points[1].custom_float_x,
 170                         GAMMA_CORR_CNTLA_END_CNTL1,
 171                         GAMMA_CORR_CNTLA_EXP_REGION_END);
 172
 173                 dm_write_reg(xfm_dce->base.ctx,
 174                         mmGAMMA_CORR_CNTLA_END_CNTL1, value);
 175         }
 176         {
 177                 value = 0;
 178                 set_reg_field_value(
 179                         value,
 180                         params->arr_points[1].custom_float_slope,
 181                         GAMMA_CORR_CNTLA_END_CNTL2,
 182                         GAMMA_CORR_CNTLA_EXP_REGION_END_BASE);
 183
 184                 set_reg_field_value(
 185                         value,
 186                         params->arr_points[1].custom_float_y,
 187                         GAMMA_CORR_CNTLA_END_CNTL2,
 188                         GAMMA_CORR_CNTLA_EXP_REGION_END_SLOPE);
 189
 190                 dm_write_reg(xfm_dce->base.ctx,
 191                         mmGAMMA_CORR_CNTLA_END_CNTL2, value);
 192         }
 193
 194         curve = params->arr_curve_points;
 195
 196         {
 197                 value = 0;
 198                 set_reg_field_value(
 199                         value,
 200                         curve[0].offset,
 201                         GAMMA_CORR_CNTLA_REGION_0_1,
 202                         GAMMA_CORR_CNTLA_EXP_REGION0_LUT_OFFSET);
 203
 204                 set_reg_field_value(
 205                         value,
 206                         curve[0].segments_num,
 207                         GAMMA_CORR_CNTLA_REGION_0_1,
 208                         GAMMA_CORR_CNTLA_EXP_REGION0_NUM_SEGMENTS);
 209
 210                 set_reg_field_value(
 211                         value,
 212                         curve[1].offset,
 213                         GAMMA_CORR_CNTLA_REGION_0_1,
 214                         GAMMA_CORR_CNTLA_EXP_REGION1_LUT_OFFSET);
 215
 216                 set_reg_field_value(
 217                         value,
 218                         curve[1].segments_num,
 219                         GAMMA_CORR_CNTLA_REGION_0_1,
 220                         GAMMA_CORR_CNTLA_EXP_REGION1_NUM_SEGMENTS);
 221
 222                 dm_write_reg(
 223                                 xfm_dce->base.ctx,
 224                         mmGAMMA_CORR_CNTLA_REGION_0_1,
 225                         value);
 226         }
 227
 228         curve += 2;
 229         {
 230                 value = 0;
 231                 set_reg_field_value(
 232                         value,
 233                         curve[0].offset,
 234                         GAMMA_CORR_CNTLA_REGION_2_3,
 235                         GAMMA_CORR_CNTLA_EXP_REGION2_LUT_OFFSET);
 236
 237                 set_reg_field_value(
 238                         value,
 239                         curve[0].segments_num,
 240                         GAMMA_CORR_CNTLA_REGION_2_3,
 241                         GAMMA_CORR_CNTLA_EXP_REGION2_NUM_SEGMENTS);
 242
 243                 set_reg_field_value(
 244                         value,
 245                         curve[1].offset,
 246                         GAMMA_CORR_CNTLA_REGION_2_3,
 247                         GAMMA_CORR_CNTLA_EXP_REGION3_LUT_OFFSET);
 248
 249                 set_reg_field_value(
 250                         value,
 251                         curve[1].segments_num,
 252                         GAMMA_CORR_CNTLA_REGION_2_3,
 253                         GAMMA_CORR_CNTLA_EXP_REGION3_NUM_SEGMENTS);
 254
 255                 dm_write_reg(xfm_dce->base.ctx,
 256                         mmGAMMA_CORR_CNTLA_REGION_2_3,
 257                         value);
 258         }
 259
 260         curve += 2;
 261         {
 262                 value = 0;
 263                 set_reg_field_value(
 264                         value,
 265                         curve[0].offset,
 266                         GAMMA_CORR_CNTLA_REGION_4_5,
 267                         GAMMA_CORR_CNTLA_EXP_REGION4_LUT_OFFSET);
 268
 269                 set_reg_field_value(
 270                         value,
 271                         curve[0].segments_num,
 272                         GAMMA_CORR_CNTLA_REGION_4_5,
 273                         GAMMA_CORR_CNTLA_EXP_REGION4_NUM_SEGMENTS);
 274
 275                 set_reg_field_value(
 276                         value,
 277                         curve[1].offset,
 278                         GAMMA_CORR_CNTLA_REGION_4_5,
 279                         GAMMA_CORR_CNTLA_EXP_REGION5_LUT_OFFSET);
 280
 281                 set_reg_field_value(
 282                         value,
 283                         curve[1].segments_num,
 284                         GAMMA_CORR_CNTLA_REGION_4_5,
 285                         GAMMA_CORR_CNTLA_EXP_REGION5_NUM_SEGMENTS);
 286
 287                 dm_write_reg(xfm_dce->base.ctx,
 288                         mmGAMMA_CORR_CNTLA_REGION_4_5,
 289                         value);
 290         }
 291
 292         curve += 2;
 293         {
 294                 value = 0;
 295                 set_reg_field_value(
 296                         value,
 297                         curve[0].offset,
 298                         GAMMA_CORR_CNTLA_REGION_6_7,
 299                         GAMMA_CORR_CNTLA_EXP_REGION6_LUT_OFFSET);
 300
 301                 set_reg_field_value(
 302                         value,
 303                         curve[0].segments_num,
 304                         GAMMA_CORR_CNTLA_REGION_6_7,
 305                         GAMMA_CORR_CNTLA_EXP_REGION6_NUM_SEGMENTS);
 306
 307                 set_reg_field_value(
 308                         value,
 309                         curve[1].offset,
 310                         GAMMA_CORR_CNTLA_REGION_6_7,
 311                         GAMMA_CORR_CNTLA_EXP_REGION7_LUT_OFFSET);
 312
 313                 set_reg_field_value(
 314                         value,
 315                         curve[1].segments_num,
 316                         GAMMA_CORR_CNTLA_REGION_6_7,
 317                         GAMMA_CORR_CNTLA_EXP_REGION7_NUM_SEGMENTS);
 318
 319                 dm_write_reg(xfm_dce->base.ctx,
 320                         mmGAMMA_CORR_CNTLA_REGION_6_7,
 321                         value);
 322         }
 323
 324         curve += 2;
 325         {
 326                 value = 0;
 327                 set_reg_field_value(
 328                         value,
 329                         curve[0].offset,
 330                         GAMMA_CORR_CNTLA_REGION_8_9,
 331                         GAMMA_CORR_CNTLA_EXP_REGION8_LUT_OFFSET);
 332
 333                 set_reg_field_value(
 334                         value,
 335                         curve[0].segments_num,
 336                         GAMMA_CORR_CNTLA_REGION_8_9,
 337                         GAMMA_CORR_CNTLA_EXP_REGION8_NUM_SEGMENTS);
 338
 339                 set_reg_field_value(
 340                         value,
 341                         curve[1].offset,
 342                         GAMMA_CORR_CNTLA_REGION_8_9,
 343                         GAMMA_CORR_CNTLA_EXP_REGION9_LUT_OFFSET);
 344
 345                 set_reg_field_value(
 346                         value,
 347                         curve[1].segments_num,
 348                         GAMMA_CORR_CNTLA_REGION_8_9,
 349                         GAMMA_CORR_CNTLA_EXP_REGION9_NUM_SEGMENTS);
 350
 351                 dm_write_reg(xfm_dce->base.ctx,
 352                         mmGAMMA_CORR_CNTLA_REGION_8_9,
 353                         value);
 354         }
 355
 356         curve += 2;
 357         {
 358                 value = 0;
 359                 set_reg_field_value(
 360                         value,
 361                         curve[0].offset,
 362                         GAMMA_CORR_CNTLA_REGION_10_11,
 363                         GAMMA_CORR_CNTLA_EXP_REGION10_LUT_OFFSET);
 364
 365                 set_reg_field_value(
 366                         value,
 367                         curve[0].segments_num,
 368                         GAMMA_CORR_CNTLA_REGION_10_11,
 369                         GAMMA_CORR_CNTLA_EXP_REGION10_NUM_SEGMENTS);
 370
 371                 set_reg_field_value(
 372                         value,
 373                         curve[1].offset,
 374                         GAMMA_CORR_CNTLA_REGION_10_11,
 375                         GAMMA_CORR_CNTLA_EXP_REGION11_LUT_OFFSET);
 376
 377                 set_reg_field_value(
 378                         value,
 379                         curve[1].segments_num,
 380                         GAMMA_CORR_CNTLA_REGION_10_11,
 381                         GAMMA_CORR_CNTLA_EXP_REGION11_NUM_SEGMENTS);
 382
 383                 dm_write_reg(xfm_dce->base.ctx,
 384                         mmGAMMA_CORR_CNTLA_REGION_10_11,
 385                         value);
 386         }
 387
 388         curve += 2;
 389         {
 390                 value = 0;
 391                 set_reg_field_value(
 392                         value,
 393                         curve[0].offset,
 394                         GAMMA_CORR_CNTLA_REGION_12_13,
 395                         GAMMA_CORR_CNTLA_EXP_REGION12_LUT_OFFSET);
 396
 397                 set_reg_field_value(
 398                         value,
 399                         curve[0].segments_num,
 400                         GAMMA_CORR_CNTLA_REGION_12_13,
 401                         GAMMA_CORR_CNTLA_EXP_REGION12_NUM_SEGMENTS);
 402
 403                 set_reg_field_value(
 404                         value,
 405                         curve[1].offset,
 406                         GAMMA_CORR_CNTLA_REGION_12_13,
 407                         GAMMA_CORR_CNTLA_EXP_REGION13_LUT_OFFSET);
 408
 409                 set_reg_field_value(
 410                         value,
 411                         curve[1].segments_num,
 412                         GAMMA_CORR_CNTLA_REGION_12_13,
 413                         GAMMA_CORR_CNTLA_EXP_REGION13_NUM_SEGMENTS);
 414
 415                 dm_write_reg(xfm_dce->base.ctx,
 416                         mmGAMMA_CORR_CNTLA_REGION_12_13,
 417                         value);
 418         }
 419
 420         curve += 2;
 421         {
 422                 value = 0;
 423                 set_reg_field_value(
 424                         value,
 425                         curve[0].offset,
 426                         GAMMA_CORR_CNTLA_REGION_14_15,
 427                         GAMMA_CORR_CNTLA_EXP_REGION14_LUT_OFFSET);
 428
 429                 set_reg_field_value(
 430                         value,
 431                         curve[0].segments_num,
 432                         GAMMA_CORR_CNTLA_REGION_14_15,
 433                         GAMMA_CORR_CNTLA_EXP_REGION14_NUM_SEGMENTS);
 434
 435                 set_reg_field_value(
 436                         value,
 437                         curve[1].offset,
 438                         GAMMA_CORR_CNTLA_REGION_14_15,
 439                         GAMMA_CORR_CNTLA_EXP_REGION15_LUT_OFFSET);
 440
 441                 set_reg_field_value(
 442                         value,
 443                         curve[1].segments_num,
 444                         GAMMA_CORR_CNTLA_REGION_14_15,
 445                         GAMMA_CORR_CNTLA_EXP_REGION15_NUM_SEGMENTS);
 446
 447                 dm_write_reg(xfm_dce->base.ctx,
 448                         mmGAMMA_CORR_CNTLA_REGION_14_15,
 449                         value);
 450         }
 451 }
 452
 453 static void program_pwl(struct dce_transform *xfm_dce,
 454                 const struct pwl_params *params)
 455 {
 456         uint32_t value = 0;
 457
 458         set_reg_field_value(
 459                 value,
 460                 7,
 461                 GAMMA_CORR_LUT_WRITE_EN_MASK,
 462                 GAMMA_CORR_LUT_WRITE_EN_MASK);
 463
 464         dm_write_reg(xfm_dce->base.ctx,
 465                 mmGAMMA_CORR_LUT_WRITE_EN_MASK, value);
 466
 467         dm_write_reg(xfm_dce->base.ctx,
 468                 mmGAMMA_CORR_LUT_INDEX, 0);
 469
 470         /* Program REGAMMA_LUT_DATA */
 471         {
 472                 const uint32_t addr = mmGAMMA_CORR_LUT_DATA;
 473                 uint32_t i = 0;
 474                 const struct pwl_result_data *rgb =
 475                                 params->rgb_resulted;
 476
 477                 while (i != params->hw_points_num) {
 478                         dm_write_reg(xfm_dce->base.ctx, addr, rgb->red_reg);
 479                         dm_write_reg(xfm_dce->base.ctx, addr, rgb->green_reg);
 480                         dm_write_reg(xfm_dce->base.ctx, addr, rgb->blue_reg);
 481
 482                         dm_write_reg(xfm_dce->base.ctx, addr,
 483                                 rgb->delta_red_reg);
 484                         dm_write_reg(xfm_dce->base.ctx, addr,
 485                                 rgb->delta_green_reg);
 486                         dm_write_reg(xfm_dce->base.ctx, addr,
 487                                 rgb->delta_blue_reg);
 488
 489                         ++rgb;
 490                         ++i;
 491                 }
 492         }
 493 }
 494
 495 void dce110_opp_program_regamma_pwl_v(
 496         struct transform *xfm,
 497         const struct pwl_params *params)
 498 {
 499         struct dce_transform *xfm_dce = TO_DCE_TRANSFORM(xfm);
 500
 501         /* Setup regions */
 502         regamma_config_regions_and_segments(xfm_dce, params);
 503
 504         set_bypass_input_gamma(xfm_dce);
 505
 506         /* Power on gamma LUT memory */
 507         power_on_lut(xfm, true, false, true);
 508
 509         /* Program PWL */
 510         program_pwl(xfm_dce, params);
 511
 512         /* program regamma config */
 513         configure_regamma_mode(xfm_dce, 1);
 514
 515         /* Power return to auto back */
 516         power_on_lut(xfm, false, false, true);
 517 }
 518
 519 void dce110_opp_power_on_regamma_lut_v(
 520         struct transform *xfm,
 521         bool power_on)
 522 {
 523         uint32_t value = dm_read_reg(xfm->ctx, mmDCFEV_MEM_PWR_CTRL);
 524
 525         set_reg_field_value(
 526                 value,
 527                 0,
 528                 DCFEV_MEM_PWR_CTRL,
 529                 COL_MAN_GAMMA_CORR_MEM_PWR_FORCE);
 530
 531         set_reg_field_value(
 532                 value,
 533                 power_on,
 534                 DCFEV_MEM_PWR_CTRL,
 535                 COL_MAN_GAMMA_CORR_MEM_PWR_DIS);
 536
 537         set_reg_field_value(
 538                 value,
 539                 0,
 540                 DCFEV_MEM_PWR_CTRL,
 541                 COL_MAN_INPUT_GAMMA_MEM_PWR_FORCE);
 542
 543         set_reg_field_value(
 544                 value,
 545                 power_on,
 546                 DCFEV_MEM_PWR_CTRL,
 547                 COL_MAN_INPUT_GAMMA_MEM_PWR_DIS);
 548
 549         dm_write_reg(xfm->ctx, mmDCFEV_MEM_PWR_CTRL, value);
 550 }
 551
 552 void dce110_opp_set_regamma_mode_v(
 553         struct transform *xfm,
 554         enum opp_regamma mode)
 555 {
 556         // TODO: need to implement the function
 557 }