drivers/gpu/drm/amd/display/dc/bios/command_table2.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 "dm_services.h"
  27
  28 #include "ObjectID.h"
  29
  30 #include "atomfirmware.h"
  31 #include "atom.h"
  32 #include "include/bios_parser_interface.h"
  33
  34 #include "command_table2.h"
  35 #include "command_table_helper2.h"
  36 #include "bios_parser_helper.h"
  37 #include "bios_parser_types_internal2.h"
  38 #include "amdgpu.h"
  39
  40 #include "dc_dmub_srv.h"
  41 #include "dc.h"
  42
  43 #define DC_LOGGER \
  44         bp->base.ctx->logger
  45
  46 #define GET_INDEX_INTO_MASTER_TABLE(MasterOrData, FieldName)\
  47         (((char *)(&((\
  48                 struct atom_master_list_of_##MasterOrData##_functions_v2_1 *)0)\
  49                 ->FieldName)-(char *)0)/sizeof(uint16_t))
  50
  51 #define EXEC_BIOS_CMD_TABLE(fname, params)\
  52         (amdgpu_atom_execute_table(((struct amdgpu_device *)bp->base.ctx->driver_context)->mode_info.atom_context, \
  53                 GET_INDEX_INTO_MASTER_TABLE(command, fname), \
  54                 (uint32_t *)&params) == 0)
  55
  56 #define BIOS_CMD_TABLE_REVISION(fname, frev, crev)\
  57         amdgpu_atom_parse_cmd_header(((struct amdgpu_device *)bp->base.ctx->driver_context)->mode_info.atom_context, \
  58                 GET_INDEX_INTO_MASTER_TABLE(command, fname), &frev, &crev)
  59
  60 #define BIOS_CMD_TABLE_PARA_REVISION(fname)\
  61         bios_cmd_table_para_revision(bp->base.ctx->driver_context, \
  62                         GET_INDEX_INTO_MASTER_TABLE(command, fname))
  63
  64
  65
  66 static uint32_t bios_cmd_table_para_revision(void *dev,
  67                                              uint32_t index)
  68 {
  69         struct amdgpu_device *adev = dev;
  70         uint8_t frev, crev;
  71
  72         if (amdgpu_atom_parse_cmd_header(adev->mode_info.atom_context,
  73                                         index,
  74                                         &frev, &crev))
  75                 return crev;
  76         else
  77                 return 0;
  78 }
  79
  80 /******************************************************************************
  81  ******************************************************************************
  82  **
  83  **                  D I G E N C O D E R C O N T R O L
  84  **
  85  ******************************************************************************
  86  *****************************************************************************/
  87
  88 static enum bp_result encoder_control_digx_v1_5(
  89         struct bios_parser *bp,
  90         struct bp_encoder_control *cntl);
  91
  92 static enum bp_result encoder_control_fallback(
  93         struct bios_parser *bp,
  94         struct bp_encoder_control *cntl);
  95
  96 static void init_dig_encoder_control(struct bios_parser *bp)
  97 {
  98         uint32_t version =
  99                 BIOS_CMD_TABLE_PARA_REVISION(digxencodercontrol);
 100
 101         switch (version) {
 102         case 5:
 103                 bp->cmd_tbl.dig_encoder_control = encoder_control_digx_v1_5;
 104                 break;
 105         default:
 106                 dm_output_to_console("Don't have dig_encoder_control for v%d\n", version);
 107                 bp->cmd_tbl.dig_encoder_control = encoder_control_fallback;
 108                 break;
 109         }
 110 }
 111
 112 static void encoder_control_dmcub(
 113                 struct dc_dmub_srv *dmcub,
 114                 struct dig_encoder_stream_setup_parameters_v1_5 *dig)
 115 {
 116         union dmub_rb_cmd cmd;
 117
 118         memset(&cmd, 0, sizeof(cmd));
 119
 120         cmd.digx_encoder_control.header.type = DMUB_CMD__VBIOS;
 121         cmd.digx_encoder_control.header.sub_type =
 122                 DMUB_CMD__VBIOS_DIGX_ENCODER_CONTROL;
 123         cmd.digx_encoder_control.header.payload_bytes =
 124                 sizeof(cmd.digx_encoder_control) -
 125                 sizeof(cmd.digx_encoder_control.header);
 126         cmd.digx_encoder_control.encoder_control.dig.stream_param = *dig;
 127
 128         dc_dmub_srv_cmd_queue(dmcub, &cmd);
 129         dc_dmub_srv_cmd_execute(dmcub);
 130         dc_dmub_srv_wait_idle(dmcub);
 131 }
 132
 133 static enum bp_result encoder_control_digx_v1_5(
 134         struct bios_parser *bp,
 135         struct bp_encoder_control *cntl)
 136 {
 137         enum bp_result result = BP_RESULT_FAILURE;
 138         struct dig_encoder_stream_setup_parameters_v1_5 params = {0};
 139
 140         params.digid = (uint8_t)(cntl->engine_id);
 141         params.action = bp->cmd_helper->encoder_action_to_atom(cntl->action);
 142
 143         params.pclk_10khz = cntl->pixel_clock / 10;
 144         params.digmode =
 145                         (uint8_t)(bp->cmd_helper->encoder_mode_bp_to_atom(
 146                                         cntl->signal,
 147                                         cntl->enable_dp_audio));
 148         params.lanenum = (uint8_t)(cntl->lanes_number);
 149
 150         switch (cntl->color_depth) {
 151         case COLOR_DEPTH_888:
 152                 params.bitpercolor = PANEL_8BIT_PER_COLOR;
 153                 break;
 154         case COLOR_DEPTH_101010:
 155                 params.bitpercolor = PANEL_10BIT_PER_COLOR;
 156                 break;
 157         case COLOR_DEPTH_121212:
 158                 params.bitpercolor = PANEL_12BIT_PER_COLOR;
 159                 break;
 160         case COLOR_DEPTH_161616:
 161                 params.bitpercolor = PANEL_16BIT_PER_COLOR;
 162                 break;
 163         default:
 164                 break;
 165         }
 166
 167         if (cntl->signal == SIGNAL_TYPE_HDMI_TYPE_A)
 168                 switch (cntl->color_depth) {
 169                 case COLOR_DEPTH_101010:
 170                         params.pclk_10khz =
 171                                 (params.pclk_10khz * 30) / 24;
 172                         break;
 173                 case COLOR_DEPTH_121212:
 174                         params.pclk_10khz =
 175                                 (params.pclk_10khz * 36) / 24;
 176                         break;
 177                 case COLOR_DEPTH_161616:
 178                         params.pclk_10khz =
 179                                 (params.pclk_10khz * 48) / 24;
 180                         break;
 181                 default:
 182                         break;
 183                 }
 184
 185         if (bp->base.ctx->dc->ctx->dmub_srv &&
 186             bp->base.ctx->dc->debug.dmub_command_table) {
 187                 encoder_control_dmcub(bp->base.ctx->dmub_srv, &params);
 188                 return BP_RESULT_OK;
 189         }
 190
 191         if (EXEC_BIOS_CMD_TABLE(digxencodercontrol, params))
 192                 result = BP_RESULT_OK;
 193
 194         return result;
 195 }
 196
 197 static enum bp_result encoder_control_fallback(
 198         struct bios_parser *bp,
 199         struct bp_encoder_control *cntl)
 200 {
 201         if (bp->base.ctx->dc->ctx->dmub_srv &&
 202             bp->base.ctx->dc->debug.dmub_command_table) {
 203                 return encoder_control_digx_v1_5(bp, cntl);
 204         }
 205
 206         return BP_RESULT_FAILURE;
 207 }
 208
 209 /*****************************************************************************
 210  ******************************************************************************
 211  **
 212  **                  TRANSMITTER CONTROL
 213  **
 214  ******************************************************************************
 215  *****************************************************************************/
 216
 217 static enum bp_result transmitter_control_v1_6(
 218         struct bios_parser *bp,
 219         struct bp_transmitter_control *cntl);
 220
 221 static enum bp_result transmitter_control_fallback(
 222         struct bios_parser *bp,
 223         struct bp_transmitter_control *cntl);
 224
 225 static void init_transmitter_control(struct bios_parser *bp)
 226 {
 227         uint8_t frev;
 228         uint8_t crev;
 229
 230         BIOS_CMD_TABLE_REVISION(dig1transmittercontrol, frev, crev);
 231
 232         switch (crev) {
 233         case 6:
 234                 bp->cmd_tbl.transmitter_control = transmitter_control_v1_6;
 235                 break;
 236         default:
 237                 dm_output_to_console("Don't have transmitter_control for v%d\n", crev);
 238                 bp->cmd_tbl.transmitter_control = transmitter_control_fallback;
 239                 break;
 240         }
 241 }
 242
 243 static void transmitter_control_dmcub(
 244                 struct dc_dmub_srv *dmcub,
 245                 struct dig_transmitter_control_parameters_v1_6 *dig)
 246 {
 247         union dmub_rb_cmd cmd;
 248
 249         memset(&cmd, 0, sizeof(cmd));
 250
 251         cmd.dig1_transmitter_control.header.type = DMUB_CMD__VBIOS;
 252         cmd.dig1_transmitter_control.header.sub_type =
 253                 DMUB_CMD__VBIOS_DIG1_TRANSMITTER_CONTROL;
 254         cmd.dig1_transmitter_control.header.payload_bytes =
 255                 sizeof(cmd.dig1_transmitter_control) -
 256                 sizeof(cmd.dig1_transmitter_control.header);
 257         cmd.dig1_transmitter_control.transmitter_control.dig = *dig;
 258
 259         dc_dmub_srv_cmd_queue(dmcub, &cmd);
 260         dc_dmub_srv_cmd_execute(dmcub);
 261         dc_dmub_srv_wait_idle(dmcub);
 262 }
 263
 264 static enum bp_result transmitter_control_v1_6(
 265         struct bios_parser *bp,
 266         struct bp_transmitter_control *cntl)
 267 {
 268         enum bp_result result = BP_RESULT_FAILURE;
 269         const struct command_table_helper *cmd = bp->cmd_helper;
 270         struct dig_transmitter_control_ps_allocation_v1_6 ps = { { 0 } };
 271
 272         ps.param.phyid = cmd->phy_id_to_atom(cntl->transmitter);
 273         ps.param.action = (uint8_t)cntl->action;
 274
 275         if (cntl->action == TRANSMITTER_CONTROL_SET_VOLTAGE_AND_PREEMPASIS)
 276                 ps.param.mode_laneset.dplaneset = (uint8_t)cntl->lane_settings;
 277         else
 278                 ps.param.mode_laneset.digmode =
 279                                 cmd->signal_type_to_atom_dig_mode(cntl->signal);
 280
 281         ps.param.lanenum = (uint8_t)cntl->lanes_number;
 282         ps.param.hpdsel = cmd->hpd_sel_to_atom(cntl->hpd_sel);
 283         ps.param.digfe_sel = cmd->dig_encoder_sel_to_atom(cntl->engine_id);
 284         ps.param.connobj_id = (uint8_t)cntl->connector_obj_id.id;
 285         ps.param.symclk_10khz = cntl->pixel_clock/10;
 286
 287
 288         if (cntl->action == TRANSMITTER_CONTROL_ENABLE ||
 289                 cntl->action == TRANSMITTER_CONTROL_ACTIAVATE ||
 290                 cntl->action == TRANSMITTER_CONTROL_DEACTIVATE) {
 291                 DC_LOG_BIOS("%s:ps.param.symclk_10khz = %d\n",\
 292                 __func__, ps.param.symclk_10khz);
 293         }
 294
 295         if (bp->base.ctx->dc->ctx->dmub_srv &&
 296             bp->base.ctx->dc->debug.dmub_command_table) {
 297                 transmitter_control_dmcub(bp->base.ctx->dmub_srv, &ps.param);
 298                 return BP_RESULT_OK;
 299         }
 300
 301 /*color_depth not used any more, driver has deep color factor in the Phyclk*/
 302         if (EXEC_BIOS_CMD_TABLE(dig1transmittercontrol, ps))
 303                 result = BP_RESULT_OK;
 304         return result;
 305 }
 306
 307 static enum bp_result transmitter_control_fallback(
 308         struct bios_parser *bp,
 309         struct bp_transmitter_control *cntl)
 310 {
 311         if (bp->base.ctx->dc->ctx->dmub_srv &&
 312             bp->base.ctx->dc->debug.dmub_command_table) {
 313                 return transmitter_control_v1_6(bp, cntl);
 314         }
 315
 316         return BP_RESULT_FAILURE;
 317 }
 318
 319 /******************************************************************************
 320  ******************************************************************************
 321  **
 322  **                  SET PIXEL CLOCK
 323  **
 324  ******************************************************************************
 325  *****************************************************************************/
 326
 327 static enum bp_result set_pixel_clock_v7(
 328         struct bios_parser *bp,
 329         struct bp_pixel_clock_parameters *bp_params);
 330
 331 static enum bp_result set_pixel_clock_fallback(
 332         struct bios_parser *bp,
 333         struct bp_pixel_clock_parameters *bp_params);
 334
 335 static void init_set_pixel_clock(struct bios_parser *bp)
 336 {
 337         switch (BIOS_CMD_TABLE_PARA_REVISION(setpixelclock)) {
 338         case 7:
 339                 bp->cmd_tbl.set_pixel_clock = set_pixel_clock_v7;
 340                 break;
 341         default:
 342                 dm_output_to_console("Don't have set_pixel_clock for v%d\n",
 343                          BIOS_CMD_TABLE_PARA_REVISION(setpixelclock));
 344                 bp->cmd_tbl.set_pixel_clock = set_pixel_clock_fallback;
 345                 break;
 346         }
 347 }
 348
 349 static void set_pixel_clock_dmcub(
 350                 struct dc_dmub_srv *dmcub,
 351                 struct set_pixel_clock_parameter_v1_7 *clk)
 352 {
 353         union dmub_rb_cmd cmd;
 354
 355         memset(&cmd, 0, sizeof(cmd));
 356
 357         cmd.set_pixel_clock.header.type = DMUB_CMD__VBIOS;
 358         cmd.set_pixel_clock.header.sub_type = DMUB_CMD__VBIOS_SET_PIXEL_CLOCK;
 359         cmd.set_pixel_clock.header.payload_bytes =
 360                 sizeof(cmd.set_pixel_clock) -
 361                 sizeof(cmd.set_pixel_clock.header);
 362         cmd.set_pixel_clock.pixel_clock.clk = *clk;
 363
 364         dc_dmub_srv_cmd_queue(dmcub, &cmd);
 365         dc_dmub_srv_cmd_execute(dmcub);
 366         dc_dmub_srv_wait_idle(dmcub);
 367 }
 368
 369 static enum bp_result set_pixel_clock_v7(
 370         struct bios_parser *bp,
 371         struct bp_pixel_clock_parameters *bp_params)
 372 {
 373         enum bp_result result = BP_RESULT_FAILURE;
 374         struct set_pixel_clock_parameter_v1_7 clk;
 375         uint8_t controller_id;
 376         uint32_t pll_id;
 377
 378         memset(&clk, 0, sizeof(clk));
 379
 380         if (bp->cmd_helper->clock_source_id_to_atom(bp_params->pll_id, &pll_id)
 381                         && bp->cmd_helper->controller_id_to_atom(bp_params->
 382                                         controller_id, &controller_id)) {
 383                 /* Note: VBIOS still wants to use ucCRTC name which is now
 384                  * 1 byte in ULONG
 385                  *typedef struct _CRTC_PIXEL_CLOCK_FREQ
 386                  *{
 387                  * target the pixel clock to drive the CRTC timing.
 388                  * ULONG ulPixelClock:24;
 389                  * 0 means disable PPLL/DCPLL. Expanded to 24 bits comparing to
 390                  * previous version.
 391                  * ATOM_CRTC1~6, indicate the CRTC controller to
 392                  * ULONG ucCRTC:8;
 393                  * drive the pixel clock. not used for DCPLL case.
 394                  *}CRTC_PIXEL_CLOCK_FREQ;
 395                  *union
 396                  *{
 397                  * pixel clock and CRTC id frequency
 398                  * CRTC_PIXEL_CLOCK_FREQ ulCrtcPclkFreq;
 399                  * ULONG ulDispEngClkFreq; dispclk frequency
 400                  *};
 401                  */
 402                 clk.crtc_id = controller_id;
 403                 clk.pll_id = (uint8_t) pll_id;
 404                 clk.encoderobjid =
 405                         bp->cmd_helper->encoder_id_to_atom(
 406                                 dal_graphics_object_id_get_encoder_id(
 407                                         bp_params->encoder_object_id));
 408
 409                 clk.encoder_mode = (uint8_t) bp->
 410                         cmd_helper->encoder_mode_bp_to_atom(
 411                                 bp_params->signal_type, false);
 412
 413                 clk.pixclk_100hz = cpu_to_le32(bp_params->target_pixel_clock_100hz);
 414
 415                 clk.deep_color_ratio =
 416                         (uint8_t) bp->cmd_helper->
 417                                 transmitter_color_depth_to_atom(
 418                                         bp_params->color_depth);
 419
 420                 DC_LOG_BIOS("%s:program display clock = %d, tg = %d, pll = %d, "\
 421                                 "colorDepth = %d\n", __func__,
 422                                 bp_params->target_pixel_clock_100hz, (int)controller_id,
 423                                 pll_id, bp_params->color_depth);
 424
 425                 if (bp_params->flags.FORCE_PROGRAMMING_OF_PLL)
 426                         clk.miscinfo |= PIXEL_CLOCK_V7_MISC_FORCE_PROG_PPLL;
 427
 428                 if (bp_params->flags.PROGRAM_PHY_PLL_ONLY)
 429                         clk.miscinfo |= PIXEL_CLOCK_V7_MISC_PROG_PHYPLL;
 430
 431                 if (bp_params->flags.SUPPORT_YUV_420)
 432                         clk.miscinfo |= PIXEL_CLOCK_V7_MISC_YUV420_MODE;
 433
 434                 if (bp_params->flags.SET_XTALIN_REF_SRC)
 435                         clk.miscinfo |= PIXEL_CLOCK_V7_MISC_REF_DIV_SRC_XTALIN;
 436
 437                 if (bp_params->flags.SET_GENLOCK_REF_DIV_SRC)
 438                         clk.miscinfo |= PIXEL_CLOCK_V7_MISC_REF_DIV_SRC_GENLK;
 439
 440                 if (bp_params->signal_type == SIGNAL_TYPE_DVI_DUAL_LINK)
 441                         clk.miscinfo |= PIXEL_CLOCK_V7_MISC_DVI_DUALLINK_EN;
 442
 443                 if (bp->base.ctx->dc->ctx->dmub_srv &&
 444                     bp->base.ctx->dc->debug.dmub_command_table) {
 445                         set_pixel_clock_dmcub(bp->base.ctx->dmub_srv, &clk);
 446                         return BP_RESULT_OK;
 447                 }
 448
 449                 if (EXEC_BIOS_CMD_TABLE(setpixelclock, clk))
 450                         result = BP_RESULT_OK;
 451         }
 452         return result;
 453 }
 454
 455 static enum bp_result set_pixel_clock_fallback(
 456         struct bios_parser *bp,
 457         struct bp_pixel_clock_parameters *bp_params)
 458 {
 459         if (bp->base.ctx->dc->ctx->dmub_srv &&
 460             bp->base.ctx->dc->debug.dmub_command_table) {
 461                 return set_pixel_clock_v7(bp, bp_params);
 462         }
 463
 464         return BP_RESULT_FAILURE;
 465 }
 466
 467 /******************************************************************************
 468  ******************************************************************************
 469  **
 470  **                  SET CRTC TIMING
 471  **
 472  ******************************************************************************
 473  *****************************************************************************/
 474
 475 static enum bp_result set_crtc_using_dtd_timing_v3(
 476         struct bios_parser *bp,
 477         struct bp_hw_crtc_timing_parameters *bp_params);
 478
 479 static void init_set_crtc_timing(struct bios_parser *bp)
 480 {
 481         uint32_t dtd_version =
 482                         BIOS_CMD_TABLE_PARA_REVISION(setcrtc_usingdtdtiming);
 483
 484         switch (dtd_version) {
 485         case 3:
 486                 bp->cmd_tbl.set_crtc_timing =
 487                         set_crtc_using_dtd_timing_v3;
 488                 break;
 489         default:
 490                 dm_output_to_console("Don't have set_crtc_timing for v%d\n", dtd_version);
 491                 bp->cmd_tbl.set_crtc_timing = NULL;
 492                 break;
 493         }
 494 }
 495
 496 static enum bp_result set_crtc_using_dtd_timing_v3(
 497         struct bios_parser *bp,
 498         struct bp_hw_crtc_timing_parameters *bp_params)
 499 {
 500         enum bp_result result = BP_RESULT_FAILURE;
 501         struct set_crtc_using_dtd_timing_parameters params = {0};
 502         uint8_t atom_controller_id;
 503
 504         if (bp->cmd_helper->controller_id_to_atom(
 505                         bp_params->controller_id, &atom_controller_id))
 506                 params.crtc_id = atom_controller_id;
 507
 508         /* bios usH_Size wants h addressable size */
 509         params.h_size = cpu_to_le16((uint16_t)bp_params->h_addressable);
 510         /* bios usH_Blanking_Time wants borders included in blanking */
 511         params.h_blanking_time =
 512                         cpu_to_le16((uint16_t)(bp_params->h_total -
 513                                         bp_params->h_addressable));
 514         /* bios usV_Size wants v addressable size */
 515         params.v_size = cpu_to_le16((uint16_t)bp_params->v_addressable);
 516         /* bios usV_Blanking_Time wants borders included in blanking */
 517         params.v_blanking_time =
 518                         cpu_to_le16((uint16_t)(bp_params->v_total -
 519                                         bp_params->v_addressable));
 520         /* bios usHSyncOffset is the offset from the end of h addressable,
 521          * our horizontalSyncStart is the offset from the beginning
 522          * of h addressable
 523          */
 524         params.h_syncoffset =
 525                         cpu_to_le16((uint16_t)(bp_params->h_sync_start -
 526                                         bp_params->h_addressable));
 527         params.h_syncwidth = cpu_to_le16((uint16_t)bp_params->h_sync_width);
 528         /* bios usHSyncOffset is the offset from the end of v addressable,
 529          * our verticalSyncStart is the offset from the beginning of
 530          * v addressable
 531          */
 532         params.v_syncoffset =
 533                         cpu_to_le16((uint16_t)(bp_params->v_sync_start -
 534                                         bp_params->v_addressable));
 535         params.v_syncwidth = cpu_to_le16((uint16_t)bp_params->v_sync_width);
 536
 537         /* we assume that overscan from original timing does not get bigger
 538          * than 255
 539          * we will program all the borders in the Set CRTC Overscan call below
 540          */
 541
 542         if (bp_params->flags.HSYNC_POSITIVE_POLARITY == 0)
 543                 params.modemiscinfo =
 544                                 cpu_to_le16(le16_to_cpu(params.modemiscinfo) |
 545                                                 ATOM_HSYNC_POLARITY);
 546
 547         if (bp_params->flags.VSYNC_POSITIVE_POLARITY == 0)
 548                 params.modemiscinfo =
 549                                 cpu_to_le16(le16_to_cpu(params.modemiscinfo) |
 550                                                 ATOM_VSYNC_POLARITY);
 551
 552         if (bp_params->flags.INTERLACE) {
 553                 params.modemiscinfo =
 554                                 cpu_to_le16(le16_to_cpu(params.modemiscinfo) |
 555                                                 ATOM_INTERLACE);
 556
 557                 /* original DAL code has this condition to apply this
 558                  * for non-TV/CV only
 559                  * due to complex MV testing for possible impact
 560                  * if ( pACParameters->signal != SignalType_YPbPr &&
 561                  *  pACParameters->signal != SignalType_Composite &&
 562                  *  pACParameters->signal != SignalType_SVideo)
 563                  */
 564                 {
 565                         /* HW will deduct 0.5 line from 2nd feild.
 566                          * i.e. for 1080i, it is 2 lines for 1st field,
 567                          * 2.5 lines for the 2nd feild. we need input as 5
 568                          * instead of 4.
 569                          * but it is 4 either from Edid data (spec CEA 861)
 570                          * or CEA timing table.
 571                          */
 572                         le16_add_cpu(&params.v_syncoffset, 1);
 573                 }
 574         }
 575
 576         if (bp_params->flags.HORZ_COUNT_BY_TWO)
 577                 params.modemiscinfo =
 578                         cpu_to_le16(le16_to_cpu(params.modemiscinfo) |
 579                                         0x100); /* ATOM_DOUBLE_CLOCK_MODE */
 580
 581         if (EXEC_BIOS_CMD_TABLE(setcrtc_usingdtdtiming, params))
 582                 result = BP_RESULT_OK;
 583
 584         return result;
 585 }
 586
 587 /******************************************************************************
 588  ******************************************************************************
 589  **
 590  **                  ENABLE CRTC
 591  **
 592  ******************************************************************************
 593  *****************************************************************************/
 594
 595 static enum bp_result enable_crtc_v1(
 596         struct bios_parser *bp,
 597         enum controller_id controller_id,
 598         bool enable);
 599
 600 static void init_enable_crtc(struct bios_parser *bp)
 601 {
 602         switch (BIOS_CMD_TABLE_PARA_REVISION(enablecrtc)) {
 603         case 1:
 604                 bp->cmd_tbl.enable_crtc = enable_crtc_v1;
 605                 break;
 606         default:
 607                 dm_output_to_console("Don't have enable_crtc for v%d\n",
 608                          BIOS_CMD_TABLE_PARA_REVISION(enablecrtc));
 609                 bp->cmd_tbl.enable_crtc = NULL;
 610                 break;
 611         }
 612 }
 613
 614 static enum bp_result enable_crtc_v1(
 615         struct bios_parser *bp,
 616         enum controller_id controller_id,
 617         bool enable)
 618 {
 619         bool result = BP_RESULT_FAILURE;
 620         struct enable_crtc_parameters params = {0};
 621         uint8_t id;
 622
 623         if (bp->cmd_helper->controller_id_to_atom(controller_id, &id))
 624                 params.crtc_id = id;
 625         else
 626                 return BP_RESULT_BADINPUT;
 627
 628         if (enable)
 629                 params.enable = ATOM_ENABLE;
 630         else
 631                 params.enable = ATOM_DISABLE;
 632
 633         if (EXEC_BIOS_CMD_TABLE(enablecrtc, params))
 634                 result = BP_RESULT_OK;
 635
 636         return result;
 637 }
 638
 639 /******************************************************************************
 640  ******************************************************************************
 641  **
 642  **                  DISPLAY PLL
 643  **
 644  ******************************************************************************
 645  *****************************************************************************/
 646
 647
 648
 649 /******************************************************************************
 650  ******************************************************************************
 651  **
 652  **                  EXTERNAL ENCODER CONTROL
 653  **
 654  ******************************************************************************
 655  *****************************************************************************/
 656
 657 static enum bp_result external_encoder_control_v3(
 658         struct bios_parser *bp,
 659         struct bp_external_encoder_control *cntl);
 660
 661 static void init_external_encoder_control(
 662         struct bios_parser *bp)
 663 {
 664         switch (BIOS_CMD_TABLE_PARA_REVISION(externalencodercontrol)) {
 665         case 3:
 666                 bp->cmd_tbl.external_encoder_control =
 667                                 external_encoder_control_v3;
 668                 break;
 669         default:
 670                 bp->cmd_tbl.external_encoder_control = NULL;
 671                 break;
 672         }
 673 }
 674
 675 static enum bp_result external_encoder_control_v3(
 676         struct bios_parser *bp,
 677         struct bp_external_encoder_control *cntl)
 678 {
 679         /* TODO */
 680         return BP_RESULT_OK;
 681 }
 682
 683 /******************************************************************************
 684  ******************************************************************************
 685  **
 686  **                  ENABLE DISPLAY POWER GATING
 687  **
 688  ******************************************************************************
 689  *****************************************************************************/
 690
 691 static enum bp_result enable_disp_power_gating_v2_1(
 692         struct bios_parser *bp,
 693         enum controller_id crtc_id,
 694         enum bp_pipe_control_action action);
 695
 696 static enum bp_result enable_disp_power_gating_fallback(
 697         struct bios_parser *bp,
 698         enum controller_id crtc_id,
 699         enum bp_pipe_control_action action);
 700
 701 static void init_enable_disp_power_gating(
 702         struct bios_parser *bp)
 703 {
 704         switch (BIOS_CMD_TABLE_PARA_REVISION(enabledisppowergating)) {
 705         case 1:
 706                 bp->cmd_tbl.enable_disp_power_gating =
 707                                 enable_disp_power_gating_v2_1;
 708                 break;
 709         default:
 710                 dm_output_to_console("Don't enable_disp_power_gating enable_crtc for v%d\n",
 711                          BIOS_CMD_TABLE_PARA_REVISION(enabledisppowergating));
 712                 bp->cmd_tbl.enable_disp_power_gating = enable_disp_power_gating_fallback;
 713                 break;
 714         }
 715 }
 716
 717 static void enable_disp_power_gating_dmcub(
 718         struct dc_dmub_srv *dmcub,
 719         struct enable_disp_power_gating_parameters_v2_1 *pwr)
 720 {
 721         union dmub_rb_cmd cmd;
 722
 723         memset(&cmd, 0, sizeof(cmd));
 724
 725         cmd.enable_disp_power_gating.header.type = DMUB_CMD__VBIOS;
 726         cmd.enable_disp_power_gating.header.sub_type =
 727                 DMUB_CMD__VBIOS_ENABLE_DISP_POWER_GATING;
 728         cmd.enable_disp_power_gating.header.payload_bytes =
 729                 sizeof(cmd.enable_disp_power_gating) -
 730                 sizeof(cmd.enable_disp_power_gating.header);
 731         cmd.enable_disp_power_gating.power_gating.pwr = *pwr;
 732
 733         dc_dmub_srv_cmd_queue(dmcub, &cmd);
 734         dc_dmub_srv_cmd_execute(dmcub);
 735         dc_dmub_srv_wait_idle(dmcub);
 736 }
 737
 738 static enum bp_result enable_disp_power_gating_v2_1(
 739         struct bios_parser *bp,
 740         enum controller_id crtc_id,
 741         enum bp_pipe_control_action action)
 742 {
 743         enum bp_result result = BP_RESULT_FAILURE;
 744
 745
 746         struct enable_disp_power_gating_ps_allocation ps = { { 0 } };
 747         uint8_t atom_crtc_id;
 748
 749         if (bp->cmd_helper->controller_id_to_atom(crtc_id, &atom_crtc_id))
 750                 ps.param.disp_pipe_id = atom_crtc_id;
 751         else
 752                 return BP_RESULT_BADINPUT;
 753
 754         ps.param.enable =
 755                 bp->cmd_helper->disp_power_gating_action_to_atom(action);
 756
 757         if (bp->base.ctx->dc->ctx->dmub_srv &&
 758             bp->base.ctx->dc->debug.dmub_command_table) {
 759                 enable_disp_power_gating_dmcub(bp->base.ctx->dmub_srv,
 760                                                &ps.param);
 761                 return BP_RESULT_OK;
 762         }
 763
 764         if (EXEC_BIOS_CMD_TABLE(enabledisppowergating, ps.param))
 765                 result = BP_RESULT_OK;
 766
 767         return result;
 768 }
 769
 770 static enum bp_result enable_disp_power_gating_fallback(
 771         struct bios_parser *bp,
 772         enum controller_id crtc_id,
 773         enum bp_pipe_control_action action)
 774 {
 775         if (bp->base.ctx->dc->ctx->dmub_srv &&
 776             bp->base.ctx->dc->debug.dmub_command_table) {
 777                 return enable_disp_power_gating_v2_1(bp, crtc_id, action);
 778         }
 779
 780         return BP_RESULT_FAILURE;
 781 }
 782
 783 /******************************************************************************
 784 *******************************************************************************
 785  **
 786  **                  SET DCE CLOCK
 787  **
 788 *******************************************************************************
 789 *******************************************************************************/
 790
 791 static enum bp_result set_dce_clock_v2_1(
 792         struct bios_parser *bp,
 793         struct bp_set_dce_clock_parameters *bp_params);
 794
 795 static void init_set_dce_clock(struct bios_parser *bp)
 796 {
 797         switch (BIOS_CMD_TABLE_PARA_REVISION(setdceclock)) {
 798         case 1:
 799                 bp->cmd_tbl.set_dce_clock = set_dce_clock_v2_1;
 800                 break;
 801         default:
 802                 dm_output_to_console("Don't have set_dce_clock for v%d\n",
 803                          BIOS_CMD_TABLE_PARA_REVISION(setdceclock));
 804                 bp->cmd_tbl.set_dce_clock = NULL;
 805                 break;
 806         }
 807 }
 808
 809 static enum bp_result set_dce_clock_v2_1(
 810         struct bios_parser *bp,
 811         struct bp_set_dce_clock_parameters *bp_params)
 812 {
 813         enum bp_result result = BP_RESULT_FAILURE;
 814
 815         struct set_dce_clock_ps_allocation_v2_1 params;
 816         uint32_t atom_pll_id;
 817         uint32_t atom_clock_type;
 818         const struct command_table_helper *cmd = bp->cmd_helper;
 819
 820         memset(&params, 0, sizeof(params));
 821
 822         if (!cmd->clock_source_id_to_atom(bp_params->pll_id, &atom_pll_id) ||
 823                         !cmd->dc_clock_type_to_atom(bp_params->clock_type,
 824                                         &atom_clock_type))
 825                 return BP_RESULT_BADINPUT;
 826
 827         params.param.dceclksrc  = atom_pll_id;
 828         params.param.dceclktype = atom_clock_type;
 829
 830         if (bp_params->clock_type == DCECLOCK_TYPE_DPREFCLK) {
 831                 if (bp_params->flags.USE_GENLOCK_AS_SOURCE_FOR_DPREFCLK)
 832                         params.param.dceclkflag |=
 833                                         DCE_CLOCK_FLAG_PLL_REFCLK_SRC_GENLK;
 834
 835                 if (bp_params->flags.USE_PCIE_AS_SOURCE_FOR_DPREFCLK)
 836                         params.param.dceclkflag |=
 837                                         DCE_CLOCK_FLAG_PLL_REFCLK_SRC_PCIE;
 838
 839                 if (bp_params->flags.USE_XTALIN_AS_SOURCE_FOR_DPREFCLK)
 840                         params.param.dceclkflag |=
 841                                         DCE_CLOCK_FLAG_PLL_REFCLK_SRC_XTALIN;
 842
 843                 if (bp_params->flags.USE_GENERICA_AS_SOURCE_FOR_DPREFCLK)
 844                         params.param.dceclkflag |=
 845                                         DCE_CLOCK_FLAG_PLL_REFCLK_SRC_GENERICA;
 846         } else
 847                 /* only program clock frequency if display clock is used;
 848                  * VBIOS will program DPREFCLK
 849                  * We need to convert from KHz units into 10KHz units
 850                  */
 851                 params.param.dceclk_10khz = cpu_to_le32(
 852                                 bp_params->target_clock_frequency / 10);
 853         DC_LOG_BIOS("%s:target_clock_frequency = %d"\
 854                         "clock_type = %d \n", __func__,\
 855                         bp_params->target_clock_frequency,\
 856                         bp_params->clock_type);
 857
 858         if (EXEC_BIOS_CMD_TABLE(setdceclock, params)) {
 859                 /* Convert from 10KHz units back to KHz */
 860                 bp_params->target_clock_frequency = le32_to_cpu(
 861                                 params.param.dceclk_10khz) * 10;
 862                 result = BP_RESULT_OK;
 863         }
 864
 865         return result;
 866 }
 867
 868
 869 /******************************************************************************
 870  ******************************************************************************
 871  **
 872  **                  GET SMU CLOCK INFO
 873  **
 874  ******************************************************************************
 875  *****************************************************************************/
 876
 877 static unsigned int get_smu_clock_info_v3_1(struct bios_parser *bp, uint8_t id);
 878
 879 static void init_get_smu_clock_info(struct bios_parser *bp)
 880 {
 881         /* TODO add switch for table vrsion */
 882         bp->cmd_tbl.get_smu_clock_info = get_smu_clock_info_v3_1;
 883
 884 }
 885
 886 static unsigned int get_smu_clock_info_v3_1(struct bios_parser *bp, uint8_t id)
 887 {
 888         struct atom_get_smu_clock_info_parameters_v3_1 smu_input = {0};
 889         struct atom_get_smu_clock_info_output_parameters_v3_1 smu_output;
 890
 891         smu_input.command = GET_SMU_CLOCK_INFO_V3_1_GET_PLLVCO_FREQ;
 892         smu_input.syspll_id = id;
 893
 894         /* Get Specific Clock */
 895         if (EXEC_BIOS_CMD_TABLE(getsmuclockinfo, smu_input)) {
 896                 memmove(&smu_output, &smu_input, sizeof(
 897                         struct atom_get_smu_clock_info_parameters_v3_1));
 898                 return smu_output.atom_smu_outputclkfreq.syspllvcofreq_10khz;
 899         }
 900
 901         return 0;
 902 }
 903
 904 /******************************************************************************
 905  ******************************************************************************
 906  **
 907  **                  LVTMA CONTROL
 908  **
 909  ******************************************************************************
 910  *****************************************************************************/
 911
 912 static enum bp_result enable_lvtma_control(
 913         struct bios_parser *bp,
 914         uint8_t uc_pwr_on);
 915
 916 static void init_enable_lvtma_control(struct bios_parser *bp)
 917 {
 918         /* TODO add switch for table vrsion */
 919         bp->cmd_tbl.enable_lvtma_control = enable_lvtma_control;
 920
 921 }
 922
 923 static void enable_lvtma_control_dmcub(
 924         struct dc_dmub_srv *dmcub,
 925         uint8_t uc_pwr_on)
 926 {
 927
 928         union dmub_rb_cmd cmd;
 929
 930         memset(&cmd, 0, sizeof(cmd));
 931
 932         cmd.cmd_common.header.type = DMUB_CMD__VBIOS;
 933         cmd.cmd_common.header.sub_type =
 934                         DMUB_CMD__VBIOS_LVTMA_CONTROL;
 935         cmd.cmd_common.cmd_buffer[0] =
 936                         uc_pwr_on;
 937
 938         dc_dmub_srv_cmd_queue(dmcub, &cmd);
 939         dc_dmub_srv_cmd_execute(dmcub);
 940         dc_dmub_srv_wait_idle(dmcub);
 941
 942 }
 943
 944 static enum bp_result enable_lvtma_control(
 945         struct bios_parser *bp,
 946         uint8_t uc_pwr_on)
 947 {
 948         enum bp_result result = BP_RESULT_FAILURE;
 949
 950         if (bp->base.ctx->dc->ctx->dmub_srv &&
 951             bp->base.ctx->dc->debug.dmub_command_table) {
 952                 enable_lvtma_control_dmcub(bp->base.ctx->dmub_srv,
 953                                 uc_pwr_on);
 954                 return BP_RESULT_OK;
 955         }
 956         return result;
 957 }
 958
 959 void dal_firmware_parser_init_cmd_tbl(struct bios_parser *bp)
 960 {
 961         init_dig_encoder_control(bp);
 962         init_transmitter_control(bp);
 963         init_set_pixel_clock(bp);
 964
 965         init_set_crtc_timing(bp);
 966
 967         init_enable_crtc(bp);
 968
 969         init_external_encoder_control(bp);
 970         init_enable_disp_power_gating(bp);
 971         init_set_dce_clock(bp);
 972         init_get_smu_clock_info(bp);
 973
 974         init_enable_lvtma_control(bp);
 975 }