drivers/gpu/drm/rockchip/cdn-dp-reg.c

   1 /*
   2  * Copyright (C) Fuzhou Rockchip Electronics Co.Ltd
   3  * Author: Chris Zhong <zyw@rock-chips.com>
   4  *
   5  * This software is licensed under the terms of the GNU General Public
   6  * License version 2, as published by the Free Software Foundation, and
   7  * may be copied, distributed, and modified under those terms.
   8  *
   9  * This program is distributed in the hope that it will be useful,
  10  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  11  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  12  * GNU General Public License for more details.
  13  */
  14
  15 #include <linux/clk.h>
  16 #include <linux/device.h>
  17 #include <linux/delay.h>
  18 #include <linux/io.h>
  19 #include <linux/iopoll.h>
  20 #include <linux/reset.h>
  21
  22 #include "cdn-dp-core.h"
  23 #include "cdn-dp-reg.h"
  24
  25 #define CDN_DP_SPDIF_CLK                200000000
  26 #define FW_ALIVE_TIMEOUT_US             1000000
  27 #define MAILBOX_RETRY_US                1000
  28 #define MAILBOX_TIMEOUT_US              5000000
  29 #define LINK_TRAINING_RETRY_MS          20
  30 #define LINK_TRAINING_TIMEOUT_MS        500
  31
  32 void cdn_dp_set_fw_clk(struct cdn_dp_device *dp, unsigned long clk)
  33 {
  34         writel(clk / 1000000, dp->regs + SW_CLK_H);
  35 }
  36
  37 void cdn_dp_clock_reset(struct cdn_dp_device *dp)
  38 {
  39         u32 val;
  40
  41         val = DPTX_FRMR_DATA_CLK_RSTN_EN |
  42               DPTX_FRMR_DATA_CLK_EN |
  43               DPTX_PHY_DATA_RSTN_EN |
  44               DPTX_PHY_DATA_CLK_EN |
  45               DPTX_PHY_CHAR_RSTN_EN |
  46               DPTX_PHY_CHAR_CLK_EN |
  47               SOURCE_AUX_SYS_CLK_RSTN_EN |
  48               SOURCE_AUX_SYS_CLK_EN |
  49               DPTX_SYS_CLK_RSTN_EN |
  50               DPTX_SYS_CLK_EN |
  51               CFG_DPTX_VIF_CLK_RSTN_EN |
  52               CFG_DPTX_VIF_CLK_EN;
  53         writel(val, dp->regs + SOURCE_DPTX_CAR);
  54
  55         val = SOURCE_PHY_RSTN_EN | SOURCE_PHY_CLK_EN;
  56         writel(val, dp->regs + SOURCE_PHY_CAR);
  57
  58         val = SOURCE_PKT_SYS_RSTN_EN |
  59               SOURCE_PKT_SYS_CLK_EN |
  60               SOURCE_PKT_DATA_RSTN_EN |
  61               SOURCE_PKT_DATA_CLK_EN;
  62         writel(val, dp->regs + SOURCE_PKT_CAR);
  63
  64         val = SPDIF_CDR_CLK_RSTN_EN |
  65               SPDIF_CDR_CLK_EN |
  66               SOURCE_AIF_SYS_RSTN_EN |
  67               SOURCE_AIF_SYS_CLK_EN |
  68               SOURCE_AIF_CLK_RSTN_EN |
  69               SOURCE_AIF_CLK_EN;
  70         writel(val, dp->regs + SOURCE_AIF_CAR);
  71
  72         val = SOURCE_CIPHER_SYSTEM_CLK_RSTN_EN |
  73               SOURCE_CIPHER_SYS_CLK_EN |
  74               SOURCE_CIPHER_CHAR_CLK_RSTN_EN |
  75               SOURCE_CIPHER_CHAR_CLK_EN;
  76         writel(val, dp->regs + SOURCE_CIPHER_CAR);
  77
  78         val = SOURCE_CRYPTO_SYS_CLK_RSTN_EN |
  79               SOURCE_CRYPTO_SYS_CLK_EN;
  80         writel(val, dp->regs + SOURCE_CRYPTO_CAR);
  81
  82         /* enable Mailbox and PIF interrupt */
  83         writel(0, dp->regs + APB_INT_MASK);
  84 }
  85
  86 static int cdn_dp_mailbox_read(struct cdn_dp_device *dp)
  87 {
  88         int val, ret;
  89
  90         ret = readx_poll_timeout(readl, dp->regs + MAILBOX_EMPTY_ADDR,
  91                                  val, !val, MAILBOX_RETRY_US,
  92                                  MAILBOX_TIMEOUT_US);
  93         if (ret < 0)
  94                 return ret;
  95
  96         return readl(dp->regs + MAILBOX0_RD_DATA) & 0xff;
  97 }
  98
  99 static int cdp_dp_mailbox_write(struct cdn_dp_device *dp, u8 val)
 100 {
 101         int ret, full;
 102
 103         ret = readx_poll_timeout(readl, dp->regs + MAILBOX_FULL_ADDR,
 104                                  full, !full, MAILBOX_RETRY_US,
 105                                  MAILBOX_TIMEOUT_US);
 106         if (ret < 0)
 107                 return ret;
 108
 109         writel(val, dp->regs + MAILBOX0_WR_DATA);
 110
 111         return 0;
 112 }
 113
 114 static int cdn_dp_mailbox_validate_receive(struct cdn_dp_device *dp,
 115                                            u8 module_id, u8 opcode,
 116                                            u16 req_size)
 117 {
 118         u32 mbox_size, i;
 119         u8 header[4];
 120         int ret;
 121
 122         /* read the header of the message */
 123         for (i = 0; i < 4; i++) {
 124                 ret = cdn_dp_mailbox_read(dp);
 125                 if (ret < 0)
 126                         return ret;
 127
 128                 header[i] = ret;
 129         }
 130
 131         mbox_size = (header[2] << 8) | header[3];
 132
 133         if (opcode != header[0] || module_id != header[1] ||
 134             req_size != mbox_size) {
 135                 /*
 136                  * If the message in mailbox is not what we want, we need to
 137                  * clear the mailbox by reading its contents.
 138                  */
 139                 for (i = 0; i < mbox_size; i++)
 140                         if (cdn_dp_mailbox_read(dp) < 0)
 141                                 break;
 142
 143                 return -EINVAL;
 144         }
 145
 146         return 0;
 147 }
 148
 149 static int cdn_dp_mailbox_read_receive(struct cdn_dp_device *dp,
 150                                        u8 *buff, u16 buff_size)
 151 {
 152         u32 i;
 153         int ret;
 154
 155         for (i = 0; i < buff_size; i++) {
 156                 ret = cdn_dp_mailbox_read(dp);
 157                 if (ret < 0)
 158                         return ret;
 159
 160                 buff[i] = ret;
 161         }
 162
 163         return 0;
 164 }
 165
 166 static int cdn_dp_mailbox_send(struct cdn_dp_device *dp, u8 module_id,
 167                                u8 opcode, u16 size, u8 *message)
 168 {
 169         u8 header[4];
 170         int ret, i;
 171
 172         header[0] = opcode;
 173         header[1] = module_id;
 174         header[2] = (size >> 8) & 0xff;
 175         header[3] = size & 0xff;
 176
 177         for (i = 0; i < 4; i++) {
 178                 ret = cdp_dp_mailbox_write(dp, header[i]);
 179                 if (ret)
 180                         return ret;
 181         }
 182
 183         for (i = 0; i < size; i++) {
 184                 ret = cdp_dp_mailbox_write(dp, message[i]);
 185                 if (ret)
 186                         return ret;
 187         }
 188
 189         return 0;
 190 }
 191
 192 static int cdn_dp_reg_write(struct cdn_dp_device *dp, u16 addr, u32 val)
 193 {
 194         u8 msg[6];
 195
 196         msg[0] = (addr >> 8) & 0xff;
 197         msg[1] = addr & 0xff;
 198         msg[2] = (val >> 24) & 0xff;
 199         msg[3] = (val >> 16) & 0xff;
 200         msg[4] = (val >> 8) & 0xff;
 201         msg[5] = val & 0xff;
 202         return cdn_dp_mailbox_send(dp, MB_MODULE_ID_DP_TX, DPTX_WRITE_REGISTER,
 203                                    sizeof(msg), msg);
 204 }
 205
 206 static int cdn_dp_reg_write_bit(struct cdn_dp_device *dp, u16 addr,
 207                                 u8 start_bit, u8 bits_no, u32 val)
 208 {
 209         u8 field[8];
 210
 211         field[0] = (addr >> 8) & 0xff;
 212         field[1] = addr & 0xff;
 213         field[2] = start_bit;
 214         field[3] = bits_no;
 215         field[4] = (val >> 24) & 0xff;
 216         field[5] = (val >> 16) & 0xff;
 217         field[6] = (val >> 8) & 0xff;
 218         field[7] = val & 0xff;
 219
 220         return cdn_dp_mailbox_send(dp, MB_MODULE_ID_DP_TX, DPTX_WRITE_FIELD,
 221                                    sizeof(field), field);
 222 }
 223
 224 int cdn_dp_dpcd_read(struct cdn_dp_device *dp, u32 addr, u8 *data, u16 len)
 225 {
 226         u8 msg[5], reg[5];
 227         int ret;
 228
 229         msg[0] = (len >> 8) & 0xff;
 230         msg[1] = len & 0xff;
 231         msg[2] = (addr >> 16) & 0xff;
 232         msg[3] = (addr >> 8) & 0xff;
 233         msg[4] = addr & 0xff;
 234         ret = cdn_dp_mailbox_send(dp, MB_MODULE_ID_DP_TX, DPTX_READ_DPCD,
 235                                   sizeof(msg), msg);
 236         if (ret)
 237                 goto err_dpcd_read;
 238
 239         ret = cdn_dp_mailbox_validate_receive(dp, MB_MODULE_ID_DP_TX,
 240                                               DPTX_READ_DPCD,
 241                                               sizeof(reg) + len);
 242         if (ret)
 243                 goto err_dpcd_read;
 244
 245         ret = cdn_dp_mailbox_read_receive(dp, reg, sizeof(reg));
 246         if (ret)
 247                 goto err_dpcd_read;
 248
 249         ret = cdn_dp_mailbox_read_receive(dp, data, len);
 250
 251 err_dpcd_read:
 252         return ret;
 253 }
 254
 255 int cdn_dp_dpcd_write(struct cdn_dp_device *dp, u32 addr, u8 value)
 256 {
 257         u8 msg[6], reg[5];
 258         int ret;
 259
 260         msg[0] = 0;
 261         msg[1] = 1;
 262         msg[2] = (addr >> 16) & 0xff;
 263         msg[3] = (addr >> 8) & 0xff;
 264         msg[4] = addr & 0xff;
 265         msg[5] = value;
 266         ret = cdn_dp_mailbox_send(dp, MB_MODULE_ID_DP_TX, DPTX_WRITE_DPCD,
 267                                   sizeof(msg), msg);
 268         if (ret)
 269                 goto err_dpcd_write;
 270
 271         ret = cdn_dp_mailbox_validate_receive(dp, MB_MODULE_ID_DP_TX,
 272                                               DPTX_WRITE_DPCD, sizeof(reg));
 273         if (ret)
 274                 goto err_dpcd_write;
 275
 276         ret = cdn_dp_mailbox_read_receive(dp, reg, sizeof(reg));
 277         if (ret)
 278                 goto err_dpcd_write;
 279
 280         if (addr != (reg[2] << 16 | reg[3] << 8 | reg[4]))
 281                 ret = -EINVAL;
 282
 283 err_dpcd_write:
 284         if (ret)
 285                 DRM_DEV_ERROR(dp->dev, "dpcd write failed: %d\n", ret);
 286         return ret;
 287 }
 288
 289 int cdn_dp_load_firmware(struct cdn_dp_device *dp, const u32 *i_mem,
 290                          u32 i_size, const u32 *d_mem, u32 d_size)
 291 {
 292         u32 reg;
 293         int i, ret;
 294
 295         /* reset ucpu before load firmware*/
 296         writel(APB_IRAM_PATH | APB_DRAM_PATH | APB_XT_RESET,
 297                dp->regs + APB_CTRL);
 298
 299         for (i = 0; i < i_size; i += 4)
 300                 writel(*i_mem++, dp->regs + ADDR_IMEM + i);
 301
 302         for (i = 0; i < d_size; i += 4)
 303                 writel(*d_mem++, dp->regs + ADDR_DMEM + i);
 304
 305         /* un-reset ucpu */
 306         writel(0, dp->regs + APB_CTRL);
 307
 308         /* check the keep alive register to make sure fw working */
 309         ret = readx_poll_timeout(readl, dp->regs + KEEP_ALIVE,
 310                                  reg, reg, 2000, FW_ALIVE_TIMEOUT_US);
 311         if (ret < 0) {
 312                 DRM_DEV_ERROR(dp->dev, "failed to loaded the FW reg = %x\n",
 313                               reg);
 314                 return -EINVAL;
 315         }
 316
 317         reg = readl(dp->regs + VER_L) & 0xff;
 318         dp->fw_version = reg;
 319         reg = readl(dp->regs + VER_H) & 0xff;
 320         dp->fw_version |= reg << 8;
 321         reg = readl(dp->regs + VER_LIB_L_ADDR) & 0xff;
 322         dp->fw_version |= reg << 16;
 323         reg = readl(dp->regs + VER_LIB_H_ADDR) & 0xff;
 324         dp->fw_version |= reg << 24;
 325
 326         DRM_DEV_DEBUG(dp->dev, "firmware version: %x\n", dp->fw_version);
 327
 328         return 0;
 329 }
 330
 331 int cdn_dp_set_firmware_active(struct cdn_dp_device *dp, bool enable)
 332 {
 333         u8 msg[5];
 334         int ret, i;
 335
 336         msg[0] = GENERAL_MAIN_CONTROL;
 337         msg[1] = MB_MODULE_ID_GENERAL;
 338         msg[2] = 0;
 339         msg[3] = 1;
 340         msg[4] = enable ? FW_ACTIVE : FW_STANDBY;
 341
 342         for (i = 0; i < sizeof(msg); i++) {
 343                 ret = cdp_dp_mailbox_write(dp, msg[i]);
 344                 if (ret)
 345                         goto err_set_firmware_active;
 346         }
 347
 348         /* read the firmware state */
 349         for (i = 0; i < sizeof(msg); i++)  {
 350                 ret = cdn_dp_mailbox_read(dp);
 351                 if (ret < 0)
 352                         goto err_set_firmware_active;
 353
 354                 msg[i] = ret;
 355         }
 356
 357         ret = 0;
 358
 359 err_set_firmware_active:
 360         if (ret < 0)
 361                 DRM_DEV_ERROR(dp->dev, "set firmware active failed\n");
 362         return ret;
 363 }
 364
 365 int cdn_dp_set_host_cap(struct cdn_dp_device *dp, u8 lanes, bool flip)
 366 {
 367         u8 msg[8];
 368         int ret;
 369
 370         msg[0] = CDN_DP_MAX_LINK_RATE;
 371         msg[1] = lanes | SCRAMBLER_EN;
 372         msg[2] = VOLTAGE_LEVEL_2;
 373         msg[3] = PRE_EMPHASIS_LEVEL_3;
 374         msg[4] = PTS1 | PTS2 | PTS3 | PTS4;
 375         msg[5] = FAST_LT_NOT_SUPPORT;
 376         msg[6] = flip ? LANE_MAPPING_FLIPPED : LANE_MAPPING_NORMAL;
 377         msg[7] = ENHANCED;
 378
 379         ret = cdn_dp_mailbox_send(dp, MB_MODULE_ID_DP_TX,
 380                                   DPTX_SET_HOST_CAPABILITIES,
 381                                   sizeof(msg), msg);
 382         if (ret)
 383                 goto err_set_host_cap;
 384
 385         ret = cdn_dp_reg_write(dp, DP_AUX_SWAP_INVERSION_CONTROL,
 386                                AUX_HOST_INVERT);
 387
 388 err_set_host_cap:
 389         if (ret)
 390                 DRM_DEV_ERROR(dp->dev, "set host cap failed: %d\n", ret);
 391         return ret;
 392 }
 393
 394 int cdn_dp_event_config(struct cdn_dp_device *dp)
 395 {
 396         u8 msg[5];
 397         int ret;
 398
 399         memset(msg, 0, sizeof(msg));
 400
 401         msg[0] = DPTX_EVENT_ENABLE_HPD | DPTX_EVENT_ENABLE_TRAINING;
 402
 403         ret = cdn_dp_mailbox_send(dp, MB_MODULE_ID_DP_TX, DPTX_ENABLE_EVENT,
 404                                   sizeof(msg), msg);
 405         if (ret)
 406                 DRM_DEV_ERROR(dp->dev, "set event config failed: %d\n", ret);
 407
 408         return ret;
 409 }
 410
 411 u32 cdn_dp_get_event(struct cdn_dp_device *dp)
 412 {
 413         return readl(dp->regs + SW_EVENTS0);
 414 }
 415
 416 int cdn_dp_get_hpd_status(struct cdn_dp_device *dp)
 417 {
 418         u8 status;
 419         int ret;
 420
 421         ret = cdn_dp_mailbox_send(dp, MB_MODULE_ID_DP_TX, DPTX_HPD_STATE,
 422                                   0, NULL);
 423         if (ret)
 424                 goto err_get_hpd;
 425
 426         ret = cdn_dp_mailbox_validate_receive(dp, MB_MODULE_ID_DP_TX,
 427                                               DPTX_HPD_STATE, sizeof(status));
 428         if (ret)
 429                 goto err_get_hpd;
 430
 431         ret = cdn_dp_mailbox_read_receive(dp, &status, sizeof(status));
 432         if (ret)
 433                 goto err_get_hpd;
 434
 435         return status;
 436
 437 err_get_hpd:
 438         DRM_DEV_ERROR(dp->dev, "get hpd status failed: %d\n", ret);
 439         return ret;
 440 }
 441
 442 int cdn_dp_get_edid_block(void *data, u8 *edid,
 443                           unsigned int block, size_t length)
 444 {
 445         struct cdn_dp_device *dp = data;
 446         u8 msg[2], reg[2], i;
 447         int ret;
 448
 449         for (i = 0; i < 4; i++) {
 450                 msg[0] = block / 2;
 451                 msg[1] = block % 2;
 452
 453                 ret = cdn_dp_mailbox_send(dp, MB_MODULE_ID_DP_TX, DPTX_GET_EDID,
 454                                           sizeof(msg), msg);
 455                 if (ret)
 456                         continue;
 457
 458                 ret = cdn_dp_mailbox_validate_receive(dp, MB_MODULE_ID_DP_TX,
 459                                                       DPTX_GET_EDID,
 460                                                       sizeof(reg) + length);
 461                 if (ret)
 462                         continue;
 463
 464                 ret = cdn_dp_mailbox_read_receive(dp, reg, sizeof(reg));
 465                 if (ret)
 466                         continue;
 467
 468                 ret = cdn_dp_mailbox_read_receive(dp, edid, length);
 469                 if (ret)
 470                         continue;
 471
 472                 if (reg[0] == length && reg[1] == block / 2)
 473                         break;
 474         }
 475
 476         if (ret)
 477                 DRM_DEV_ERROR(dp->dev, "get block[%d] edid failed: %d\n", block,
 478                               ret);
 479
 480         return ret;
 481 }
 482
 483 static int cdn_dp_training_start(struct cdn_dp_device *dp)
 484 {
 485         unsigned long timeout;
 486         u8 msg, event[2];
 487         int ret;
 488
 489         msg = LINK_TRAINING_RUN;
 490
 491         /* start training */
 492         ret = cdn_dp_mailbox_send(dp, MB_MODULE_ID_DP_TX, DPTX_TRAINING_CONTROL,
 493                                   sizeof(msg), &msg);
 494         if (ret)
 495                 goto err_training_start;
 496
 497         timeout = jiffies + msecs_to_jiffies(LINK_TRAINING_TIMEOUT_MS);
 498         while (time_before(jiffies, timeout)) {
 499                 msleep(LINK_TRAINING_RETRY_MS);
 500                 ret = cdn_dp_mailbox_send(dp, MB_MODULE_ID_DP_TX,
 501                                           DPTX_READ_EVENT, 0, NULL);
 502                 if (ret)
 503                         goto err_training_start;
 504
 505                 ret = cdn_dp_mailbox_validate_receive(dp, MB_MODULE_ID_DP_TX,
 506                                                       DPTX_READ_EVENT,
 507                                                       sizeof(event));
 508                 if (ret)
 509                         goto err_training_start;
 510
 511                 ret = cdn_dp_mailbox_read_receive(dp, event, sizeof(event));
 512                 if (ret)
 513                         goto err_training_start;
 514
 515                 if (event[1] & EQ_PHASE_FINISHED)
 516                         return 0;
 517         }
 518
 519         ret = -ETIMEDOUT;
 520
 521 err_training_start:
 522         DRM_DEV_ERROR(dp->dev, "training failed: %d\n", ret);
 523         return ret;
 524 }
 525
 526 static int cdn_dp_get_training_status(struct cdn_dp_device *dp)
 527 {
 528         u8 status[10];
 529         int ret;
 530
 531         ret = cdn_dp_mailbox_send(dp, MB_MODULE_ID_DP_TX, DPTX_READ_LINK_STAT,
 532                                   0, NULL);
 533         if (ret)
 534                 goto err_get_training_status;
 535
 536         ret = cdn_dp_mailbox_validate_receive(dp, MB_MODULE_ID_DP_TX,
 537                                               DPTX_READ_LINK_STAT,
 538                                               sizeof(status));
 539         if (ret)
 540                 goto err_get_training_status;
 541
 542         ret = cdn_dp_mailbox_read_receive(dp, status, sizeof(status));
 543         if (ret)
 544                 goto err_get_training_status;
 545
 546         dp->link.rate = status[0];
 547         dp->link.num_lanes = status[1];
 548
 549 err_get_training_status:
 550         if (ret)
 551                 DRM_DEV_ERROR(dp->dev, "get training status failed: %d\n", ret);
 552         return ret;
 553 }
 554
 555 int cdn_dp_train_link(struct cdn_dp_device *dp)
 556 {
 557         int ret;
 558
 559         ret = cdn_dp_training_start(dp);
 560         if (ret) {
 561                 DRM_DEV_ERROR(dp->dev, "Failed to start training %d\n", ret);
 562                 return ret;
 563         }
 564
 565         ret = cdn_dp_get_training_status(dp);
 566         if (ret) {
 567                 DRM_DEV_ERROR(dp->dev, "Failed to get training stat %d\n", ret);
 568                 return ret;
 569         }
 570
 571         DRM_DEV_DEBUG_KMS(dp->dev, "rate:0x%x, lanes:%d\n", dp->link.rate,
 572                           dp->link.num_lanes);
 573         return ret;
 574 }
 575
 576 int cdn_dp_set_video_status(struct cdn_dp_device *dp, int active)
 577 {
 578         u8 msg;
 579         int ret;
 580
 581         msg = !!active;
 582
 583         ret = cdn_dp_mailbox_send(dp, MB_MODULE_ID_DP_TX, DPTX_SET_VIDEO,
 584                                   sizeof(msg), &msg);
 585         if (ret)
 586                 DRM_DEV_ERROR(dp->dev, "set video status failed: %d\n", ret);
 587
 588         return ret;
 589 }
 590
 591 static int cdn_dp_get_msa_misc(struct video_info *video,
 592                                struct drm_display_mode *mode)
 593 {
 594         u32 msa_misc;
 595         u8 val[2] = {0};
 596
 597         switch (video->color_fmt) {
 598         case PXL_RGB:
 599         case Y_ONLY:
 600                 val[0] = 0;
 601                 break;
 602         /* set YUV default color space conversion to BT601 */
 603         case YCBCR_4_4_4:
 604                 val[0] = 6 + BT_601 * 8;
 605                 break;
 606         case YCBCR_4_2_2:
 607                 val[0] = 5 + BT_601 * 8;
 608                 break;
 609         case YCBCR_4_2_0:
 610                 val[0] = 5;
 611                 break;
 612         };
 613
 614         switch (video->color_depth) {
 615         case 6:
 616                 val[1] = 0;
 617                 break;
 618         case 8:
 619                 val[1] = 1;
 620                 break;
 621         case 10:
 622                 val[1] = 2;
 623                 break;
 624         case 12:
 625                 val[1] = 3;
 626                 break;
 627         case 16:
 628                 val[1] = 4;
 629                 break;
 630         };
 631
 632         msa_misc = 2 * val[0] + 32 * val[1] +
 633                    ((video->color_fmt == Y_ONLY) ? (1 << 14) : 0);
 634
 635         return msa_misc;
 636 }
 637
 638 int cdn_dp_config_video(struct cdn_dp_device *dp)
 639 {
 640         struct video_info *video = &dp->video_info;
 641         struct drm_display_mode *mode = &dp->mode;
 642         u64 symbol;
 643         u32 val, link_rate, rem;
 644         u8 bit_per_pix, tu_size_reg = TU_SIZE;
 645         int ret;
 646
 647         bit_per_pix = (video->color_fmt == YCBCR_4_2_2) ?
 648                       (video->color_depth * 2) : (video->color_depth * 3);
 649
 650         link_rate = drm_dp_bw_code_to_link_rate(dp->link.rate) / 1000;
 651
 652         ret = cdn_dp_reg_write(dp, BND_HSYNC2VSYNC, VIF_BYPASS_INTERLACE);
 653         if (ret)
 654                 goto err_config_video;
 655
 656         ret = cdn_dp_reg_write(dp, HSYNC2VSYNC_POL_CTRL, 0);
 657         if (ret)
 658                 goto err_config_video;
 659
 660         /*
 661          * get a best tu_size and valid symbol:
 662          * 1. chose Lclk freq(162Mhz, 270Mhz, 540Mhz), set TU to 32
 663          * 2. calculate VS(valid symbol) = TU * Pclk * Bpp / (Lclk * Lanes)
 664          * 3. if VS > *.85 or VS < *.1 or VS < 2 or TU < VS + 4, then set
 665          *    TU += 2 and repeat 2nd step.
 666          */
 667         do {
 668                 tu_size_reg += 2;
 669                 symbol = tu_size_reg * mode->clock * bit_per_pix;
 670                 do_div(symbol, dp->link.num_lanes * link_rate * 8);
 671                 rem = do_div(symbol, 1000);
 672                 if (tu_size_reg > 64) {
 673                         ret = -EINVAL;
 674                         DRM_DEV_ERROR(dp->dev,
 675                                       "tu error, clk:%d, lanes:%d, rate:%d\n",
 676                                       mode->clock, dp->link.num_lanes,
 677                                       link_rate);
 678                         goto err_config_video;
 679                 }
 680         } while ((symbol <= 1) || (tu_size_reg - symbol < 4) ||
 681                  (rem > 850) || (rem < 100));
 682
 683         val = symbol + (tu_size_reg << 8);
 684         val |= TU_CNT_RST_EN;
 685         ret = cdn_dp_reg_write(dp, DP_FRAMER_TU, val);
 686         if (ret)
 687                 goto err_config_video;
 688
 689         /* set the FIFO Buffer size */
 690         val = div_u64(mode->clock * (symbol + 1), 1000) + link_rate;
 691         val /= (dp->link.num_lanes * link_rate);
 692         val = div_u64(8 * (symbol + 1), bit_per_pix) - val;
 693         val += 2;
 694         ret = cdn_dp_reg_write(dp, DP_VC_TABLE(15), val);
 695
 696         switch (video->color_depth) {
 697         case 6:
 698                 val = BCS_6;
 699                 break;
 700         case 8:
 701                 val = BCS_8;
 702                 break;
 703         case 10:
 704                 val = BCS_10;
 705                 break;
 706         case 12:
 707                 val = BCS_12;
 708                 break;
 709         case 16:
 710                 val = BCS_16;
 711                 break;
 712         };
 713
 714         val += video->color_fmt << 8;
 715         ret = cdn_dp_reg_write(dp, DP_FRAMER_PXL_REPR, val);
 716         if (ret)
 717                 goto err_config_video;
 718
 719         val = video->h_sync_polarity ? DP_FRAMER_SP_HSP : 0;
 720         val |= video->v_sync_polarity ? DP_FRAMER_SP_VSP : 0;
 721         ret = cdn_dp_reg_write(dp, DP_FRAMER_SP, val);
 722         if (ret)
 723                 goto err_config_video;
 724
 725         val = (mode->hsync_start - mode->hdisplay) << 16;
 726         val |= mode->htotal - mode->hsync_end;
 727         ret = cdn_dp_reg_write(dp, DP_FRONT_BACK_PORCH, val);
 728         if (ret)
 729                 goto err_config_video;
 730
 731         val = mode->hdisplay * bit_per_pix / 8;
 732         ret = cdn_dp_reg_write(dp, DP_BYTE_COUNT, val);
 733         if (ret)
 734                 goto err_config_video;
 735
 736         val = mode->htotal | ((mode->htotal - mode->hsync_start) << 16);
 737         ret = cdn_dp_reg_write(dp, MSA_HORIZONTAL_0, val);
 738         if (ret)
 739                 goto err_config_video;
 740
 741         val = mode->hsync_end - mode->hsync_start;
 742         val |= (mode->hdisplay << 16) | (video->h_sync_polarity << 15);
 743         ret = cdn_dp_reg_write(dp, MSA_HORIZONTAL_1, val);
 744         if (ret)
 745                 goto err_config_video;
 746
 747         val = mode->vtotal;
 748         val |= (mode->vtotal - mode->vsync_start) << 16;
 749         ret = cdn_dp_reg_write(dp, MSA_VERTICAL_0, val);
 750         if (ret)
 751                 goto err_config_video;
 752
 753         val = mode->vsync_end - mode->vsync_start;
 754         val |= (mode->vdisplay << 16) | (video->v_sync_polarity << 15);
 755         ret = cdn_dp_reg_write(dp, MSA_VERTICAL_1, val);
 756         if (ret)
 757                 goto err_config_video;
 758
 759         val = cdn_dp_get_msa_misc(video, mode);
 760         ret = cdn_dp_reg_write(dp, MSA_MISC, val);
 761         if (ret)
 762                 goto err_config_video;
 763
 764         ret = cdn_dp_reg_write(dp, STREAM_CONFIG, 1);
 765         if (ret)
 766                 goto err_config_video;
 767
 768         val = mode->hsync_end - mode->hsync_start;
 769         val |= mode->hdisplay << 16;
 770         ret = cdn_dp_reg_write(dp, DP_HORIZONTAL, val);
 771         if (ret)
 772                 goto err_config_video;
 773
 774         val = mode->vdisplay;
 775         val |= (mode->vtotal - mode->vsync_start) << 16;
 776         ret = cdn_dp_reg_write(dp, DP_VERTICAL_0, val);
 777         if (ret)
 778                 goto err_config_video;
 779
 780         val = mode->vtotal;
 781         ret = cdn_dp_reg_write(dp, DP_VERTICAL_1, val);
 782         if (ret)
 783                 goto err_config_video;
 784
 785         ret = cdn_dp_reg_write_bit(dp, DP_VB_ID, 2, 1, 0);
 786
 787 err_config_video:
 788         if (ret)
 789                 DRM_DEV_ERROR(dp->dev, "config video failed: %d\n", ret);
 790         return ret;
 791 }
 792
 793 int cdn_dp_audio_stop(struct cdn_dp_device *dp, struct audio_info *audio)
 794 {
 795         int ret;
 796
 797         ret = cdn_dp_reg_write(dp, AUDIO_PACK_CONTROL, 0);
 798         if (ret) {
 799                 DRM_DEV_ERROR(dp->dev, "audio stop failed: %d\n", ret);
 800                 return ret;
 801         }
 802
 803         writel(0, dp->regs + SPDIF_CTRL_ADDR);
 804
 805         /* clearn the audio config and reset */
 806         writel(0, dp->regs + AUDIO_SRC_CNTL);
 807         writel(0, dp->regs + AUDIO_SRC_CNFG);
 808         writel(AUDIO_SW_RST, dp->regs + AUDIO_SRC_CNTL);
 809         writel(0, dp->regs + AUDIO_SRC_CNTL);
 810
 811         /* reset smpl2pckt component  */
 812         writel(0, dp->regs + SMPL2PKT_CNTL);
 813         writel(AUDIO_SW_RST, dp->regs + SMPL2PKT_CNTL);
 814         writel(0, dp->regs + SMPL2PKT_CNTL);
 815
 816         /* reset FIFO */
 817         writel(AUDIO_SW_RST, dp->regs + FIFO_CNTL);
 818         writel(0, dp->regs + FIFO_CNTL);
 819
 820         if (audio->format == AFMT_SPDIF)
 821                 clk_disable_unprepare(dp->spdif_clk);
 822
 823         return 0;
 824 }
 825
 826 int cdn_dp_audio_mute(struct cdn_dp_device *dp, bool enable)
 827 {
 828         int ret;
 829
 830         ret = cdn_dp_reg_write_bit(dp, DP_VB_ID, 4, 1, enable);
 831         if (ret)
 832                 DRM_DEV_ERROR(dp->dev, "audio mute failed: %d\n", ret);
 833
 834         return ret;
 835 }
 836
 837 static void cdn_dp_audio_config_i2s(struct cdn_dp_device *dp,
 838                                     struct audio_info *audio)
 839 {
 840         int sub_pckt_num = 1, i2s_port_en_val = 0xf, i;
 841         u32 val;
 842
 843         if (audio->channels == 2) {
 844                 if (dp->link.num_lanes == 1)
 845                         sub_pckt_num = 2;
 846                 else
 847                         sub_pckt_num = 4;
 848
 849                 i2s_port_en_val = 1;
 850         } else if (audio->channels == 4) {
 851                 i2s_port_en_val = 3;
 852         }
 853
 854         writel(0x0, dp->regs + SPDIF_CTRL_ADDR);
 855
 856         writel(SYNC_WR_TO_CH_ZERO, dp->regs + FIFO_CNTL);
 857
 858         val = MAX_NUM_CH(audio->channels);
 859         val |= NUM_OF_I2S_PORTS(audio->channels);
 860         val |= AUDIO_TYPE_LPCM;
 861         val |= CFG_SUB_PCKT_NUM(sub_pckt_num);
 862         writel(val, dp->regs + SMPL2PKT_CNFG);
 863
 864         if (audio->sample_width == 16)
 865                 val = 0;
 866         else if (audio->sample_width == 24)
 867                 val = 1 << 9;
 868         else
 869                 val = 2 << 9;
 870
 871         val |= AUDIO_CH_NUM(audio->channels);
 872         val |= I2S_DEC_PORT_EN(i2s_port_en_val);
 873         val |= TRANS_SMPL_WIDTH_32;
 874         writel(val, dp->regs + AUDIO_SRC_CNFG);
 875
 876         for (i = 0; i < (audio->channels + 1) / 2; i++) {
 877                 if (audio->sample_width == 16)
 878                         val = (0x02 << 8) | (0x02 << 20);
 879                 else if (audio->sample_width == 24)
 880                         val = (0x0b << 8) | (0x0b << 20);
 881
 882                 val |= ((2 * i) << 4) | ((2 * i + 1) << 16);
 883                 writel(val, dp->regs + STTS_BIT_CH(i));
 884         }
 885
 886         switch (audio->sample_rate) {
 887         case 32000:
 888                 val = SAMPLING_FREQ(3) |
 889                       ORIGINAL_SAMP_FREQ(0xc);
 890                 break;
 891         case 44100:
 892                 val = SAMPLING_FREQ(0) |
 893                       ORIGINAL_SAMP_FREQ(0xf);
 894                 break;
 895         case 48000:
 896                 val = SAMPLING_FREQ(2) |
 897                       ORIGINAL_SAMP_FREQ(0xd);
 898                 break;
 899         case 88200:
 900                 val = SAMPLING_FREQ(8) |
 901                       ORIGINAL_SAMP_FREQ(0x7);
 902                 break;
 903         case 96000:
 904                 val = SAMPLING_FREQ(0xa) |
 905                       ORIGINAL_SAMP_FREQ(5);
 906                 break;
 907         case 176400:
 908                 val = SAMPLING_FREQ(0xc) |
 909                       ORIGINAL_SAMP_FREQ(3);
 910                 break;
 911         case 192000:
 912                 val = SAMPLING_FREQ(0xe) |
 913                       ORIGINAL_SAMP_FREQ(1);
 914                 break;
 915         }
 916         val |= 4;
 917         writel(val, dp->regs + COM_CH_STTS_BITS);
 918
 919         writel(SMPL2PKT_EN, dp->regs + SMPL2PKT_CNTL);
 920         writel(I2S_DEC_START, dp->regs + AUDIO_SRC_CNTL);
 921 }
 922
 923 static void cdn_dp_audio_config_spdif(struct cdn_dp_device *dp)
 924 {
 925         u32 val;
 926
 927         writel(SYNC_WR_TO_CH_ZERO, dp->regs + FIFO_CNTL);
 928
 929         val = MAX_NUM_CH(2) | AUDIO_TYPE_LPCM | CFG_SUB_PCKT_NUM(4);
 930         writel(val, dp->regs + SMPL2PKT_CNFG);
 931         writel(SMPL2PKT_EN, dp->regs + SMPL2PKT_CNTL);
 932
 933         val = SPDIF_ENABLE | SPDIF_AVG_SEL | SPDIF_JITTER_BYPASS;
 934         writel(val, dp->regs + SPDIF_CTRL_ADDR);
 935
 936         clk_prepare_enable(dp->spdif_clk);
 937         clk_set_rate(dp->spdif_clk, CDN_DP_SPDIF_CLK);
 938 }
 939
 940 int cdn_dp_audio_config(struct cdn_dp_device *dp, struct audio_info *audio)
 941 {
 942         int ret;
 943
 944         /* reset the spdif clk before config */
 945         if (audio->format == AFMT_SPDIF) {
 946                 reset_control_assert(dp->spdif_rst);
 947                 reset_control_deassert(dp->spdif_rst);
 948         }
 949
 950         ret = cdn_dp_reg_write(dp, CM_LANE_CTRL, LANE_REF_CYC);
 951         if (ret)
 952                 goto err_audio_config;
 953
 954         ret = cdn_dp_reg_write(dp, CM_CTRL, 0);
 955         if (ret)
 956                 goto err_audio_config;
 957
 958         if (audio->format == AFMT_I2S)
 959                 cdn_dp_audio_config_i2s(dp, audio);
 960         else if (audio->format == AFMT_SPDIF)
 961                 cdn_dp_audio_config_spdif(dp);
 962
 963         ret = cdn_dp_reg_write(dp, AUDIO_PACK_CONTROL, AUDIO_PACK_EN);
 964
 965 err_audio_config:
 966         if (ret)
 967                 DRM_DEV_ERROR(dp->dev, "audio config failed: %d\n", ret);
 968         return ret;
 969 }