drivers/video/rockchip/hdmi/rockchip-hdmi-lcdc.c

   1 #include "rockchip-hdmi.h"
   2
   3 static const struct hdmi_video_timing hdmi_mode[] = {
   4         {
   5                 .mode = {
   6                         .name = "720x480i@60Hz",
   7                         .refresh = 60,
   8                         .xres = 720,
   9                         .yres = 480,
  10                         .pixclock = 27000000,
  11                         .left_margin = 57,
  12                         .right_margin = 19,
  13                         .upper_margin = 15,
  14                         .lower_margin = 4,
  15                         .hsync_len = 62,
  16                         .vsync_len = 3,
  17                         .sync = 0,
  18                         .vmode = FB_VMODE_INTERLACED,
  19                         .flag = 0,
  20                 },
  21                 .vic = HDMI_720X480I_60HZ_4_3,
  22                 .vic_2nd = HDMI_720X480I_60HZ_16_9,
  23                 .pixelrepeat = 2,
  24                 .interface = OUT_P888,
  25         },
  26         {
  27                 .mode = {
  28                         .name = "720x576i@50Hz",
  29                         .refresh = 50,
  30                         .xres = 720,
  31                         .yres = 576,
  32                         .pixclock = 27000000,
  33                         .left_margin = 69,
  34                         .right_margin = 12,
  35                         .upper_margin = 19,
  36                         .lower_margin = 2,
  37                         .hsync_len = 63,
  38                         .vsync_len = 3,
  39                         .sync = 0,
  40                         .vmode = FB_VMODE_INTERLACED,
  41                         .flag = 0,
  42                 },
  43                 .vic = HDMI_720X576I_50HZ_4_3,
  44                 .vic_2nd = HDMI_720X576I_50HZ_16_9,
  45                 .pixelrepeat = 2,
  46                 .interface = OUT_P888,
  47         },
  48         {
  49                 .mode = {
  50                         .name = "720x480p@60Hz",
  51                         .refresh = 60,
  52                         .xres = 720,
  53                         .yres = 480,
  54                         .pixclock = 27000000,
  55                         .left_margin = 60,
  56                         .right_margin = 16,
  57                         .upper_margin = 30,
  58                         .lower_margin = 9,
  59                         .hsync_len = 62,
  60                         .vsync_len = 6,
  61                         .sync = 0,
  62                         .vmode = 0,
  63                         .flag = 0,
  64                 },
  65                 .vic = HDMI_720X480P_60HZ_4_3,
  66                 .vic_2nd = HDMI_720X480P_60HZ_16_9,
  67                 .pixelrepeat = 1,
  68                 .interface = OUT_P888,
  69         },
  70         {
  71                 .mode = {
  72                         .name = "720x576p@50Hz",
  73                         .refresh = 50,
  74                         .xres = 720,
  75                         .yres = 576,
  76                         .pixclock = 27000000,
  77                         .left_margin = 68,
  78                         .right_margin = 12,
  79                         .upper_margin = 39,
  80                         .lower_margin = 5,
  81                         .hsync_len = 64,
  82                         .vsync_len = 5,
  83                         .sync = 0,
  84                         .vmode = 0,
  85                         .flag = 0,
  86                 },
  87                 .vic = HDMI_720X576P_50HZ_4_3,
  88                 .vic_2nd = HDMI_720X576P_50HZ_16_9,
  89                 .pixelrepeat = 1,
  90                 .interface = OUT_P888,
  91         },
  92         {
  93                 .mode = {
  94                         .name = "1280x720p@24Hz",
  95                         .refresh = 24,
  96                         .xres = 1280,
  97                         .yres = 720,
  98                         .pixclock = 59400000,
  99                         .left_margin = 220,
 100                         .right_margin = 1760,
 101                         .upper_margin = 20,
 102                         .lower_margin = 5,
 103                         .hsync_len = 40,
 104                         .vsync_len = 5,
 105                         .sync = FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
 106                         .vmode = 0,
 107                         .flag = 0,
 108                 },
 109                 .vic = HDMI_1280X720P_24HZ,
 110                 .vic_2nd = HDMI_1280X720P_24HZ_21_9,
 111                 .pixelrepeat = 1,
 112                 .interface = OUT_P888,
 113         },
 114         {
 115                 .mode = {
 116                         .name = "1280x720p@25Hz",
 117                         .refresh = 25,
 118                         .xres = 1280,
 119                         .yres = 720,
 120                         .pixclock = 74250000,
 121                         .left_margin = 220,
 122                         .right_margin = 2420,
 123                         .upper_margin = 20,
 124                         .lower_margin = 5,
 125                         .hsync_len = 40,
 126                         .vsync_len = 5,
 127                         .sync = FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
 128                         .vmode = 0,
 129                         .flag = 0,
 130                 },
 131                 .vic = HDMI_1280X720P_25HZ,
 132                 .vic_2nd = HDMI_1280X720P_25HZ_21_9,
 133                 .pixelrepeat = 1,
 134                 .interface = OUT_P888,
 135         },
 136         {
 137                 .mode = {
 138                         .name = "1280x720p@30Hz",
 139                         .refresh = 30,
 140                         .xres = 1280,
 141                         .yres = 720,
 142                         .pixclock = 74250000,
 143                         .left_margin = 220,
 144                         .right_margin = 1760,
 145                         .upper_margin = 20,
 146                         .lower_margin = 5,
 147                         .hsync_len = 40,
 148                         .vsync_len = 5,
 149                         .sync = FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
 150                         .vmode = 0,
 151                         .flag = 0,
 152                 },
 153                 .vic = HDMI_1280X720P_30HZ,
 154                 .vic_2nd = HDMI_1280X720P_30HZ_21_9,
 155                 .pixelrepeat = 1,
 156                 .interface = OUT_P888,
 157         },
 158         {
 159                 .mode = {
 160                         .name = "1280x720p@50Hz",
 161                         .refresh = 50,
 162                         .xres = 1280,
 163                         .yres = 720,
 164                         .pixclock = 74250000,
 165                         .left_margin = 220,
 166                         .right_margin = 440,
 167                         .upper_margin = 20,
 168                         .lower_margin = 5,
 169                         .hsync_len = 40,
 170                         .vsync_len = 5,
 171                         .sync = FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
 172                         .vmode = 0,
 173                         .flag = 0,
 174                 },
 175                 .vic = HDMI_1280X720P_50HZ,
 176                 .vic_2nd = HDMI_1280X720P_50HZ_21_9,
 177                 .pixelrepeat = 1,
 178                 .interface = OUT_P888,
 179         },
 180         {
 181                 .mode = {
 182                         .name = "1280x720p@60Hz",
 183                         .refresh = 60,
 184                         .xres = 1280,
 185                         .yres = 720,
 186                         .pixclock = 74250000,
 187                         .left_margin = 220,
 188                         .right_margin = 110,
 189                         .upper_margin = 20,
 190                         .lower_margin = 5,
 191                         .hsync_len = 40,
 192                         .vsync_len = 5,
 193                         .sync = FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
 194                         .vmode = 0,
 195                         .flag = 0,
 196                 },
 197                 .vic = HDMI_1280X720P_60HZ,
 198                 .vic_2nd = HDMI_1280X720P_60HZ_21_9,
 199                 .pixelrepeat = 1,
 200                 .interface = OUT_P888,
 201         },
 202         {
 203                 .mode = {
 204                         .name = "1920x1080i@50Hz",
 205                         .refresh = 50,
 206                         .xres = 1920,
 207                         .yres = 1080,
 208                         .pixclock = 74250000,
 209                         .left_margin = 148,
 210                         .right_margin = 528,
 211                         .upper_margin = 15,
 212                         .lower_margin = 2,
 213                         .hsync_len = 44,
 214                         .vsync_len = 5,
 215                         .sync = FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
 216                         .vmode = FB_VMODE_INTERLACED,
 217                         .flag = 0,
 218                 },
 219                 .vic = HDMI_1920X1080I_50HZ,
 220                 .vic_2nd = 0,
 221                 .pixelrepeat = 1,
 222                 .interface = OUT_P888,
 223         },
 224         {
 225                 .mode = {
 226                         .name = "1920x1080i@60Hz",
 227                         .refresh = 60,
 228                         .xres = 1920,
 229                         .yres = 1080,
 230                         .pixclock = 74250000,
 231                         .left_margin = 148,
 232                         .right_margin = 88,
 233                         .upper_margin = 15,
 234                         .lower_margin = 2,
 235                         .hsync_len = 44,
 236                         .vsync_len = 5,
 237                         .sync = FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
 238                         .vmode = FB_VMODE_INTERLACED,
 239                         .flag = 0,
 240                 },
 241                 .vic = HDMI_1920X1080I_60HZ,
 242                 .vic_2nd = 0,
 243                 .pixelrepeat = 1,
 244                 .interface = OUT_P888,
 245         },
 246         {
 247                 .mode = {
 248                         .name = "1920x1080p@24Hz",
 249                         .refresh = 24,
 250                         .xres = 1920,
 251                         .yres = 1080,
 252                         .pixclock = 74250000,
 253                         .left_margin = 148,
 254                         .right_margin = 638,
 255                         .upper_margin = 36,
 256                         .lower_margin = 4,
 257                         .hsync_len = 44,
 258                         .vsync_len = 5,
 259                         .sync = FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
 260                         .vmode = 0,
 261                         .flag = 0,
 262                 },
 263                 .vic = HDMI_1920X1080P_24HZ,
 264                 .vic_2nd = HDMI_1920X1080P_24HZ_21_9,
 265                 .pixelrepeat = 1,
 266                 .interface = OUT_P888,
 267         },
 268         {
 269                 .mode = {
 270                         .name = "1920x1080p@25Hz",
 271                         .refresh = 25,
 272                         .xres = 1920,
 273                         .yres = 1080,
 274                         .pixclock = 74250000,
 275                         .left_margin = 148,
 276                         .right_margin = 528,
 277                         .upper_margin = 36,
 278                         .lower_margin = 4,
 279                         .hsync_len = 44,
 280                         .vsync_len = 5,
 281                         .sync = FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
 282                         .vmode = 0,
 283                         .flag = 0,
 284                 },
 285                 .vic = HDMI_1920X1080P_25HZ,
 286                 .vic_2nd = HDMI_1920X1080P_25HZ_21_9,
 287                 .pixelrepeat = 1,
 288                 .interface = OUT_P888,
 289         },
 290         {
 291                 .mode = {
 292                         .name = "1920x1080p@30Hz",
 293                         .refresh = 30,
 294                         .xres = 1920,
 295                         .yres = 1080,
 296                         .pixclock = 74250000,
 297                         .left_margin = 148,
 298                         .right_margin = 88,
 299                         .upper_margin = 36,
 300                         .lower_margin = 4,
 301                         .hsync_len = 44,
 302                         .vsync_len = 5,
 303                         .sync = FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
 304                         .vmode = 0,
 305                         .flag = 0,
 306                 },
 307                 .vic = HDMI_1920X1080P_30HZ,
 308                 .vic_2nd = HDMI_1920X1080P_30HZ_21_9,
 309                 .pixelrepeat = 1,
 310                 .interface = OUT_P888,
 311         },
 312         {
 313                 .mode = {
 314                         .name = "1920x1080p@50Hz",
 315                         .refresh = 50,
 316                         .xres = 1920,
 317                         .yres = 1080,
 318                         .pixclock = 148500000,
 319                         .left_margin = 148,
 320                         .right_margin = 528,
 321                         .upper_margin = 36,
 322                         .lower_margin = 4,
 323                         .hsync_len = 44,
 324                         .vsync_len = 5,
 325                         .sync = FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
 326                         .vmode = 0,
 327                         .flag = 0,
 328                 },
 329                 .vic = HDMI_1920X1080P_50HZ,
 330                 .vic_2nd = HDMI_1920X1080P_50HZ_21_9,
 331                 .pixelrepeat = 1,
 332                 .interface = OUT_P888,
 333         },
 334         {
 335                 .mode = {
 336                         .name = "1920x1080p@60Hz",
 337                         .refresh = 60,
 338                         .xres = 1920,
 339                         .yres = 1080,
 340                         .pixclock = 148500000,
 341                         .left_margin = 148,
 342                         .right_margin = 88,
 343                         .upper_margin = 36,
 344                         .lower_margin = 4,
 345                         .hsync_len = 44,
 346                         .vsync_len = 5,
 347                         .sync = FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
 348                         .vmode = 0,
 349                         .flag = 0,
 350                 },
 351                 .vic = HDMI_1920X1080P_60HZ,
 352                 .vic_2nd = HDMI_1920X1080P_60HZ_21_9,
 353                 .pixelrepeat = 1,
 354                 .interface = OUT_P888,
 355         },
 356         {
 357                 .mode = {
 358                         .name = "3840x2160p@24Hz",
 359                         .refresh = 24,
 360                         .xres = 3840,
 361                         .yres = 2160,
 362                         .pixclock = 297000000,
 363                         .left_margin = 296,
 364                         .right_margin = 1276,
 365                         .upper_margin = 72,
 366                         .lower_margin = 8,
 367                         .hsync_len = 88,
 368                         .vsync_len = 10,
 369                         .sync = FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
 370                         .vmode = 0,
 371                         .flag = 0,
 372                 },
 373                 .vic = HDMI_3840X2160P_24HZ,
 374                 .vic_2nd = HDMI_3840X2160P_24HZ_21_9,
 375                 .pixelrepeat = 1,
 376                 .interface = OUT_P888,
 377         },
 378         {
 379                 .mode = {
 380                         .name = "3840x2160p@25Hz",
 381                         .refresh = 25,
 382                         .xres = 3840,
 383                         .yres = 2160,
 384                         .pixclock = 297000000,
 385                         .left_margin = 296,
 386                         .right_margin = 1056,
 387                         .upper_margin = 72,
 388                         .lower_margin = 8,
 389                         .hsync_len = 88,
 390                         .vsync_len = 10,
 391                         .sync = FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
 392                         .vmode = 0,
 393                         .flag = 0,
 394                 },
 395                 .vic = HDMI_3840X2160P_25HZ,
 396                 .vic_2nd = HDMI_3840X2160P_25HZ_21_9,
 397                 .pixelrepeat = 1,
 398                 .interface = OUT_P888,
 399         },
 400         {
 401                 .mode = {
 402                         .name = "3840x2160p@30Hz",
 403                         .refresh = 30,
 404                         .xres = 3840,
 405                         .yres = 2160,
 406                         .pixclock = 297000000,
 407                         .left_margin = 296,
 408                         .right_margin = 176,
 409                         .upper_margin = 72,
 410                         .lower_margin = 8,
 411                         .hsync_len = 88,
 412                         .vsync_len = 10,
 413                         .sync = FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
 414                         .vmode = 0,
 415                         .flag = 0,
 416                 },
 417                 .vic = HDMI_3840X2160P_30HZ,
 418                 .vic_2nd = HDMI_3840X2160P_30HZ_21_9,
 419                 .pixelrepeat = 1,
 420                 .interface = OUT_P888,
 421         },
 422         {
 423                 .mode = {
 424                         .name = "4096x2160p@24Hz",
 425                         .refresh = 24,
 426                         .xres = 4096,
 427                         .yres = 2160,
 428                         .pixclock = 297000000,
 429                         .left_margin = 296,
 430                         .right_margin = 1020,
 431                         .upper_margin = 72,
 432                         .lower_margin = 8,
 433                         .hsync_len = 88,
 434                         .vsync_len = 10,
 435                         .sync = FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
 436                         .vmode = 0,
 437                         .flag = 0,
 438                 },
 439                 .vic = HDMI_4096X2160P_24HZ,
 440                 .vic_2nd = 0,
 441                 .pixelrepeat = 1,
 442                 .interface = OUT_P888,
 443         },
 444         {
 445                 .mode = {
 446                         .name = "4096x2160p@25Hz",
 447                         .refresh = 25,
 448                         .xres = 4096,
 449                         .yres = 2160,
 450                         .pixclock = 297000000,
 451                         .left_margin = 128,
 452                         .right_margin = 968,
 453                         .upper_margin = 72,
 454                         .lower_margin = 8,
 455                         .hsync_len = 88,
 456                         .vsync_len = 10,
 457                         .sync = FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
 458                         .vmode = 0,
 459                         .flag = 0,
 460                 },
 461                 .vic = HDMI_4096X2160P_25HZ,
 462                 .vic_2nd = 0,
 463                 .pixelrepeat = 1,
 464                 .interface = OUT_P888,
 465         },
 466         {
 467                 .mode = {
 468                         .name = "4096x2160p@30Hz",
 469                         .refresh = 30,
 470                         .xres = 4096,
 471                         .yres = 2160,
 472                         .pixclock = 297000000,
 473                         .left_margin = 128,
 474                         .right_margin = 88,
 475                         .upper_margin = 72,
 476                         .lower_margin = 8,
 477                         .hsync_len = 88,
 478                         .vsync_len = 10,
 479                         .sync = FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
 480                         .vmode = 0,
 481                         .flag = 0,
 482                 },
 483                 .vic = HDMI_4096X2160P_30HZ,
 484                 .vic_2nd = 0,
 485                 .pixelrepeat = 1,
 486                 .interface = OUT_P888,
 487         },
 488         {
 489                 .mode = {
 490                         .name = "3840x2160p@50Hz",
 491                         .refresh = 50,
 492                         .xres = 3840,
 493                         .yres = 2160,
 494                         .pixclock = 594000000,
 495                         .left_margin = 296,
 496                         .right_margin = 1056,
 497                         .upper_margin = 72,
 498                         .lower_margin = 8,
 499                         .hsync_len = 88,
 500                         .vsync_len = 10,
 501                         .sync = FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
 502                         .vmode = 0,
 503                         .flag = 0,
 504                 },
 505                 .vic = HDMI_3840X2160P_50HZ,
 506                 .vic_2nd = HDMI_3840X2160P_50HZ_21_9,
 507                 .pixelrepeat = 1,
 508                 .interface = OUT_P888,
 509         },
 510         {
 511                 .mode = {
 512                         .name = "3840x2160p@60Hz",
 513                         .refresh = 60,
 514                         .xres = 3840,
 515                         .yres = 2160,
 516                         .pixclock = 594000000,
 517                         .left_margin = 296,
 518                         .right_margin = 176,
 519                         .upper_margin = 72,
 520                         .lower_margin = 8,
 521                         .hsync_len = 88,
 522                         .vsync_len = 10,
 523                         .sync = FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
 524                         .vmode = 0,
 525                         .flag = 0,
 526                 },
 527                 .vic = HDMI_3840X2160P_60HZ,
 528                 .vic_2nd = HDMI_3840X2160P_60HZ_21_9,
 529                 .pixelrepeat = 1,
 530                 .interface = OUT_P888,
 531         },
 532         {
 533                 .mode = {
 534                         .name = "4096x2160p@50Hz",
 535                         .refresh = 50,
 536                         .xres = 4096,
 537                         .yres = 2160,
 538                         .pixclock = 594000000,
 539                         .left_margin = 128,
 540                         .right_margin = 968,
 541                         .upper_margin = 72,
 542                         .lower_margin = 8,
 543                         .hsync_len = 88,
 544                         .vsync_len = 10,
 545                         .sync = FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
 546                         .vmode = 0,
 547                         .flag = 0,
 548                 },
 549                 .vic = HDMI_4096X2160P_50HZ,
 550                 .vic_2nd = 0,
 551                 .pixelrepeat = 1,
 552                 .interface = OUT_P888,
 553         },
 554         {
 555                 .mode = {
 556                         .name = "4096x2160p@60Hz",
 557                         .refresh = 60,
 558                         .xres = 4096,
 559                         .yres = 2160,
 560                         .pixclock = 594000000,
 561                         .left_margin = 128,
 562                         .right_margin = 88,
 563                         .upper_margin = 72,
 564                         .lower_margin = 8,
 565                         .hsync_len = 88,
 566                         .vsync_len = 10,
 567                         .sync = FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
 568                         .vmode = 0,
 569                         .flag = 0,
 570                 },
 571                 .vic = HDMI_4096X2160P_60HZ,
 572                 .vic_2nd = 0,
 573                 .pixelrepeat = 1,
 574                 .interface = OUT_P888,
 575         },
 576         {
 577                 .mode = {
 578                         .name = "800x600p@60Hz",
 579                         .refresh = 60,
 580                         .xres = 800,
 581                         .yres = 600,
 582                         .pixclock = 40000000,
 583                         .left_margin = 88,
 584                         .right_margin = 40,
 585                         .upper_margin = 23,
 586                         .lower_margin = 1,
 587                         .hsync_len = 128,
 588                         .vsync_len = 4,
 589                         .sync = FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
 590                         .vmode = 0,
 591                         .flag = 0,
 592                 },
 593                 .vic = HDMI_VIDEO_DMT | 1,
 594                 .vic_2nd = 0,
 595                 .pixelrepeat = 1,
 596                 .interface = OUT_P888,
 597         },
 598         {
 599                 .mode = {
 600                         .name = "1024x768p@60Hz",
 601                         .refresh = 60,
 602                         .xres = 1024,
 603                         .yres = 768,
 604                         .pixclock = 65000000,
 605                         .left_margin = 160,
 606                         .right_margin = 24,
 607                         .upper_margin = 29,
 608                         .lower_margin = 3,
 609                         .hsync_len = 136,
 610                         .vsync_len = 6,
 611                         .sync = 0,
 612                         .vmode = 0,
 613                         .flag = 0,
 614                 },
 615                 .vic = HDMI_VIDEO_DMT | 2,
 616                 .vic_2nd = 0,
 617                 .pixelrepeat = 1,
 618                 .interface = OUT_P888,
 619         },
 620         {
 621                 .mode = {
 622                         .name = "1280x960p@60Hz",
 623                         .refresh = 60,
 624                         .xres = 1280,
 625                         .yres = 960,
 626                         .pixclock = 108000000,
 627                         .left_margin = 312,
 628                         .right_margin = 96,
 629                         .upper_margin = 36,
 630                         .lower_margin = 1,
 631                         .hsync_len = 112,
 632                         .vsync_len = 3,
 633                         .sync = FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
 634                         .vmode = 0,
 635                         .flag = 0,
 636                 },
 637                 .vic = HDMI_VIDEO_DMT | 3,
 638                 .vic_2nd = 0,
 639                 .pixelrepeat = 1,
 640                 .interface = OUT_P888,
 641         },
 642         {
 643                 .mode = {
 644                         .name = "1280x1024p@60Hz",
 645                         .refresh = 60,
 646                         .xres = 1280,
 647                         .yres = 1024,
 648                         .pixclock = 108000000,
 649                         .left_margin = 248,
 650                         .right_margin = 48,
 651                         .upper_margin = 38,
 652                         .lower_margin = 1,
 653                         .hsync_len = 112,
 654                         .vsync_len = 3,
 655                         .sync = FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
 656                         .vmode = 0,
 657                         .flag = 0,
 658                 },
 659                 .vic = HDMI_VIDEO_DMT | 4,
 660                 .vic_2nd = 0,
 661                 .pixelrepeat = 1,
 662                 .interface = OUT_P888,
 663         },
 664         {
 665                 .mode = {
 666                         .name = "1360x768p@60Hz",
 667                         .refresh = 60,
 668                         .xres = 1360,
 669                         .yres = 768,
 670                         .pixclock = 85500000,
 671                         .left_margin = 256,
 672                         .right_margin = 64,
 673                         .upper_margin = 18,
 674                         .lower_margin = 3,
 675                         .hsync_len = 112,
 676                         .vsync_len = 6,
 677                         .sync = FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
 678                         .vmode = 0,
 679                         .flag = 0,
 680                 },
 681                 .vic = HDMI_VIDEO_DMT | 5,
 682                 .vic_2nd = 0,
 683                 .pixelrepeat = 1,
 684                 .interface = OUT_P888,
 685         },
 686         {
 687                 .mode = {
 688                         .name = "1366x768p@60Hz",
 689                         .refresh = 60,
 690                         .xres = 1366,
 691                         .yres = 768,
 692                         .pixclock = 85500000,
 693                         .left_margin = 213,
 694                         .right_margin = 70,
 695                         .upper_margin = 24,
 696                         .lower_margin = 3,
 697                         .hsync_len = 143,
 698                         .vsync_len = 3,
 699                         .sync = FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
 700                         .vmode = 0,
 701                         .flag = 0,
 702                 },
 703                 .vic = HDMI_VIDEO_DMT | 6,
 704                 .vic_2nd = 0,
 705                 .pixelrepeat = 1,
 706                 .interface = OUT_P888,
 707         },
 708         {
 709                 .mode = {
 710                         .name = "1440x900p@60Hz",
 711                         .refresh = 60,
 712                         .xres = 1440,
 713                         .yres = 768,
 714                         .pixclock = 106500000,
 715                         .left_margin = 232,
 716                         .right_margin = 80,
 717                         .upper_margin = 25,
 718                         .lower_margin = 3,
 719                         .hsync_len = 152,
 720                         .vsync_len = 6,
 721                         .sync = FB_SYNC_VERT_HIGH_ACT,
 722                         .vmode = 0,
 723                         .flag = 0,
 724                 },
 725                 .vic = HDMI_VIDEO_DMT | 7,
 726                 .vic_2nd = 0,
 727                 .pixelrepeat = 1,
 728                 .interface = OUT_P888,
 729         },
 730         {
 731                 .mode = {
 732                         .name = "1600x900p@60Hz",
 733                         .refresh = 60,
 734                         .xres = 1600,
 735                         .yres = 900,
 736                         .pixclock = 108000000,
 737                         .left_margin = 96,
 738                         .right_margin = 24,
 739                         .upper_margin = 96,
 740                         .lower_margin = 1,
 741                         .hsync_len = 80,
 742                         .vsync_len = 3,
 743                         .sync = FB_SYNC_VERT_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
 744                         .vmode = 0,
 745                         .flag = 0,
 746                 },
 747                 .vic = HDMI_VIDEO_DMT | 8,
 748                 .vic_2nd = 0,
 749                 .pixelrepeat = 1,
 750                 .interface = OUT_P888,
 751         },
 752         {
 753                 .mode = {
 754                         .name = "1680x1050@60Hz",
 755                         .refresh = 60,
 756                         .xres = 1680,
 757                         .yres = 1050,
 758                         .pixclock = 146250000,
 759                         .left_margin = 280,
 760                         .right_margin = 104,
 761                         .upper_margin = 30,
 762                         .lower_margin = 3,
 763                         .hsync_len = 176,
 764                         .vsync_len = 6,
 765                         .sync = FB_SYNC_VERT_HIGH_ACT,
 766                         .vmode = 0,
 767                         .flag = 0,
 768                 },
 769                 .vic = HDMI_VIDEO_DMT | 9,
 770                 .vic_2nd = 0,
 771                 .pixelrepeat = 1,
 772                 .interface = OUT_P888,
 773         },
 774 };
 775
 776 static int hdmi_set_info(struct rk_screen *screen, struct hdmi *hdmi)
 777 {
 778         int i, vic;
 779         struct fb_videomode *mode;
 780
 781         if (screen == NULL || hdmi == NULL)
 782                 return HDMI_ERROR_FALSE;
 783
 784         if (hdmi->vic == 0)
 785                 hdmi->vic = hdmi->property->defaultmode;
 786
 787         if (hdmi->vic & HDMI_VIDEO_DMT)
 788                 vic = hdmi->vic;
 789         else
 790                 vic = hdmi->vic & HDMI_VIC_MASK;
 791         for (i = 0; i < ARRAY_SIZE(hdmi_mode); i++) {
 792                 if (hdmi_mode[i].vic == vic ||
 793                     hdmi_mode[i].vic_2nd == vic)
 794                         break;
 795         }
 796         if (i == ARRAY_SIZE(hdmi_mode))
 797                 return HDMI_ERROR_FALSE;
 798
 799         memset(screen, 0, sizeof(struct rk_screen));
 800
 801         /* screen type & face */
 802         screen->type = SCREEN_HDMI;
 803         if (hdmi->video.color_input == HDMI_COLOR_RGB_0_255)
 804                 screen->color_mode = COLOR_RGB;
 805         else
 806                 screen->color_mode = COLOR_YCBCR;
 807         if (hdmi->vic & HDMI_VIDEO_YUV420) {
 808                 if (hdmi->video.color_output_depth == 10)
 809                         screen->face = OUT_YUV_420_10BIT;
 810                 else
 811                         screen->face = OUT_YUV_420;
 812         } else {
 813                 if (hdmi->video.color_output_depth == 10)
 814                         screen->face = OUT_P101010;
 815                 else
 816                         screen->face = hdmi_mode[i].interface;
 817         }
 818         screen->pixelrepeat = hdmi_mode[i].pixelrepeat - 1;
 819         mode = (struct fb_videomode *)&(hdmi_mode[i].mode);
 820
 821         screen->mode = *mode;
 822         if (hdmi->video.format_3d == HDMI_3D_FRAME_PACKING) {
 823                 screen->mode.pixclock = 2 * mode->pixclock;
 824                 if (mode->vmode == 0) {
 825                         screen->mode.yres = 2 * mode->yres +
 826                                         mode->upper_margin +
 827                                         mode->lower_margin +
 828                                         mode->vsync_len;
 829                 } else {
 830                         screen->mode.yres = 2 * mode->yres +
 831                                             3 * (mode->upper_margin +
 832                                                  mode->lower_margin +
 833                                                  mode->vsync_len) + 2;
 834                         screen->mode.vmode = 0;
 835                 }
 836         }
 837         /* Pin polarity */
 838         if (FB_SYNC_HOR_HIGH_ACT & mode->sync)
 839                 screen->pin_hsync = 1;
 840         else
 841                 screen->pin_hsync = 0;
 842         if (FB_SYNC_VERT_HIGH_ACT & mode->sync)
 843                 screen->pin_vsync = 1;
 844         else
 845                 screen->pin_vsync = 0;
 846
 847         screen->pin_den = 0;
 848         screen->pin_dclk = 1;
 849
 850         /* Swap rule */
 851         if (hdmi->soctype > HDMI_SOC_RK3288 &&
 852             screen->color_mode > COLOR_RGB &&
 853             (screen->face == OUT_P888 ||
 854              screen->face == OUT_P101010))
 855                 screen->swap_rb = 1;
 856         else
 857                 screen->swap_rb = 0;
 858         screen->swap_rg = 0;
 859         screen->swap_gb = 0;
 860         screen->swap_delta = 0;
 861         screen->swap_dumy = 0;
 862
 863         /* Operation function*/
 864         screen->init = NULL;
 865         screen->standby = NULL;
 866
 867         screen->overscan.left = hdmi->xscale;
 868         screen->overscan.top = hdmi->yscale;
 869         screen->overscan.right = hdmi->xscale;
 870         screen->overscan.bottom = hdmi->yscale;
 871         return 0;
 872 }
 873
 874 /**
 875  * hdmi_find_best_mode: find the video mode nearest to input vic
 876  * @hdmi:
 877  * @vic: input vic
 878  *
 879  * NOTES:
 880  * If vic is zero, return the high resolution video mode vic.
 881  */
 882 int hdmi_find_best_mode(struct hdmi *hdmi, int vic)
 883 {
 884         struct list_head *pos, *head = &hdmi->edid.modelist;
 885         struct display_modelist *modelist;
 886         int found = 0;
 887
 888         if (vic) {
 889                 list_for_each(pos, head) {
 890                         modelist =
 891                                 list_entry(pos,
 892                                            struct display_modelist, list);
 893                         if (modelist->vic == vic) {
 894                                 found = 1;
 895                                 break;
 896                         }
 897                 }
 898         }
 899         if ((!vic || !found) && head->next != head) {
 900                 /* If parse edid error, we select default mode; */
 901                 if (hdmi->edid.specs &&
 902                     hdmi->edid.specs->modedb_len)
 903                         modelist = list_entry(head->next,
 904                                               struct display_modelist, list);
 905                 else
 906                         return hdmi->property->defaultmode;
 907         }
 908
 909         if (modelist != NULL)
 910                 return modelist->vic;
 911         else
 912                 return 0;
 913 }
 914 /**
 915  * hdmi_set_lcdc: switch lcdc mode to required video mode
 916  * @hdmi:
 917  *
 918  * NOTES:
 919  *
 920  */
 921 int hdmi_set_lcdc(struct hdmi *hdmi)
 922 {
 923         int rc = 0;
 924         struct rk_screen screen;
 925
 926         rc = hdmi_set_info(&screen, hdmi);
 927         if (!rc)
 928                 rk_fb_switch_screen(&screen, 1, hdmi->lcdc->id);
 929         return rc;
 930 }
 931
 932 /**
 933  * hdmi_videomode_compare - compare 2 videomodes
 934  * @mode1: first videomode
 935  * @mode2: second videomode
 936  *
 937  * RETURNS:
 938  * 1 if mode1 > mode2, 0 if mode1 = mode2, -1 mode1 < mode2
 939  */
 940 static int hdmi_videomode_compare(const struct fb_videomode *mode1,
 941                                   const struct fb_videomode *mode2)
 942 {
 943         if (mode1->xres > mode2->xres)
 944                 return 1;
 945
 946         if (mode1->xres == mode2->xres) {
 947                 if (mode1->yres > mode2->yres)
 948                         return 1;
 949                 if (mode1->yres == mode2->yres) {
 950                         if (mode1->vmode < mode2->vmode)
 951                                 return 1;
 952                         if (mode1->pixclock > mode2->pixclock)
 953                                 return 1;
 954                         if (mode1->pixclock == mode2->pixclock) {
 955                                 if (mode1->refresh > mode2->refresh)
 956                                         return 1;
 957                                 if (mode1->refresh == mode2->refresh) {
 958                                         if (mode2->flag > mode1->flag)
 959                                                 return 1;
 960                                         if (mode2->flag < mode1->flag)
 961                                                 return -1;
 962                                         if (mode2->vmode > mode1->vmode)
 963                                                 return 1;
 964                                         if (mode2->vmode == mode1->vmode)
 965                                                 return 0;
 966                                 }
 967                         }
 968                 }
 969         }
 970         return -1;
 971 }
 972
 973 /**
 974  * hdmi_add_vic - add entry to modelist according vic
 975  * @vic: vic to be added
 976  * @head: struct list_head of modelist
 977  *
 978  * NOTES:
 979  * Will only add unmatched mode entries
 980  */
 981 int hdmi_add_vic(int vic, struct list_head *head)
 982 {
 983         struct list_head *pos;
 984         struct display_modelist *modelist;
 985         int found = 0, v;
 986
 987         /*pr_info("%s vic %d\n", __FUNCTION__, vic);*/
 988         if (vic == 0)
 989                 return -1;
 990
 991         list_for_each(pos, head) {
 992                 modelist = list_entry(pos, struct display_modelist, list);
 993                 v = modelist->vic;
 994                 if (v == vic) {
 995                         found = 1;
 996                         break;
 997                 }
 998         }
 999         if (!found) {
1000                 modelist = kmalloc(sizeof(*modelist),
1001                                    GFP_KERNEL);
1002
1003                 if (!modelist)
1004                         return -ENOMEM;
1005                 memset(modelist, 0, sizeof(struct display_modelist));
1006                 modelist->vic = vic;
1007                 list_add_tail(&modelist->list, head);
1008         }
1009         return 0;
1010 }
1011
1012 /**
1013  * hdmi_add_videomode: adds videomode entry to modelist
1014  * @mode: videomode to be added
1015  * @head: struct list_head of modelist
1016  *
1017  * NOTES:
1018  * Will only add unmatched mode entries
1019  */
1020 static int hdmi_add_videomode(const struct fb_videomode *mode,
1021                               struct list_head *head)
1022 {
1023         struct list_head *pos;
1024         struct display_modelist *modelist, *modelist_new;
1025         struct fb_videomode *m;
1026         int i, found = 0;
1027
1028         for (i = 0; i < ARRAY_SIZE(hdmi_mode); i++) {
1029                 m = (struct fb_videomode *)&(hdmi_mode[i].mode);
1030                 if (fb_mode_is_equal(m, mode)) {
1031                         found = 1;
1032                         break;
1033                 }
1034         }
1035
1036         if (found) {
1037                 list_for_each(pos, head) {
1038                         modelist = list_entry(pos,
1039                                               struct display_modelist, list);
1040                         m = &modelist->mode;
1041                         if (fb_mode_is_equal(m, mode))
1042                                 return 0;
1043                         else if (hdmi_videomode_compare(m, mode) == -1)
1044                                 break;
1045                 }
1046
1047                 modelist_new = kmalloc(sizeof(*modelist_new), GFP_KERNEL);
1048                 if (!modelist_new)
1049                         return -ENOMEM;
1050                 memset(modelist_new, 0, sizeof(struct display_modelist));
1051                 modelist_new->mode = hdmi_mode[i].mode;
1052                 modelist_new->vic = hdmi_mode[i].vic;
1053                 list_add_tail(&modelist_new->list, pos);
1054         }
1055
1056         return 0;
1057 }
1058
1059 /**
1060  * hdmi_sort_modelist: sort modelist of edid
1061  * @edid: edid to be sort
1062  */
1063 static void hdmi_sort_modelist(struct hdmi_edid *edid, int feature)
1064 {
1065         struct list_head *pos, *pos_new;
1066         struct list_head head_new, *head = &edid->modelist;
1067         struct display_modelist *modelist, *modelist_new, *modelist_n;
1068         struct fb_videomode *m, *m_new;
1069         int i, compare, vic;
1070
1071         INIT_LIST_HEAD(&head_new);
1072         list_for_each(pos, head) {
1073                 modelist = list_entry(pos, struct display_modelist, list);
1074                 /*pr_info("%s vic %d\n", __function__, modelist->vic);*/
1075                 for (i = 0; i < ARRAY_SIZE(hdmi_mode); i++) {
1076                         if (modelist->vic & HDMI_VIDEO_DMT) {
1077                                 if (feature & SUPPORT_VESA_DMT)
1078                                         vic = modelist->vic;
1079                                 else
1080                                         continue;
1081                         } else {
1082                                 vic = modelist->vic & HDMI_VIC_MASK;
1083                         }
1084                         if (vic == hdmi_mode[i].vic ||
1085                             vic == hdmi_mode[i].vic_2nd) {
1086                                 if ((feature & SUPPORT_4K) == 0 &&
1087                                     hdmi_mode[i].mode.xres >= 3840)
1088                                         continue;
1089                                 if ((feature & SUPPORT_4K_4096) == 0 &&
1090                                     hdmi_mode[i].mode.xres == 4096)
1091                                         continue;
1092                                 if ((feature & SUPPORT_TMDS_600M) == 0 &&
1093                                     !(modelist->vic & HDMI_VIDEO_YUV420) &&
1094                                     hdmi_mode[i].mode.pixclock > 340000000)
1095                                         continue;
1096                                 if ((modelist->vic & HDMI_VIDEO_YUV420) &&
1097                                     (feature & SUPPORT_YUV420) == 0)
1098                                         continue;
1099                                 if ((feature & SUPPORT_1080I) == 0 &&
1100                                     hdmi_mode[i].mode.xres == 1920 &&
1101                                     (hdmi_mode[i].mode.vmode &
1102                                      FB_VMODE_INTERLACED))
1103                                         continue;
1104                                 if ((feature & SUPPORT_480I_576I) == 0 &&
1105                                     hdmi_mode[i].mode.xres == 720 &&
1106                                     hdmi_mode[i].mode.vmode &
1107                                      FB_VMODE_INTERLACED)
1108                                         continue;
1109                                 modelist->mode = hdmi_mode[i].mode;
1110                                 if (modelist->vic & HDMI_VIDEO_YUV420)
1111                                         modelist->mode.flag = 1;
1112
1113                                 compare = 1;
1114                                 m = (struct fb_videomode *)&(modelist->mode);
1115                                 list_for_each(pos_new, &head_new) {
1116                                         modelist_new =
1117                                         list_entry(pos_new,
1118                                                    struct display_modelist,
1119                                                    list);
1120                                         m_new = &modelist_new->mode;
1121                                         compare =
1122                                         hdmi_videomode_compare(m, m_new);
1123                                         if (compare != -1)
1124                                                 break;
1125                                 }
1126                                 if (compare != 0) {
1127                                         modelist_n =
1128                                                 kmalloc(sizeof(*modelist_n),
1129                                                         GFP_KERNEL);
1130                                         if (!modelist_n)
1131                                                 return;
1132                                         *modelist_n = *modelist;
1133                                         list_add_tail(&modelist_n->list,
1134                                                       pos_new);
1135                                 }
1136                                 break;
1137                         }
1138                 }
1139         }
1140         fb_destroy_modelist(head);
1141         if (head_new.next == &head_new) {
1142                 pr_info("There is no available video mode in EDID.\n");
1143                 INIT_LIST_HEAD(&edid->modelist);
1144         } else {
1145                 edid->modelist = head_new;
1146                 edid->modelist.prev->next = &edid->modelist;
1147                 edid->modelist.next->prev = &edid->modelist;
1148         }
1149 }
1150
1151 /**
1152  * hdmi_ouputmode_select - select hdmi transmitter output mode: hdmi or dvi?
1153  * @hdmi: handle of hdmi
1154  * @edid_ok: get EDID data success or not, HDMI_ERROR_SUCESS means success.
1155  */
1156 int hdmi_ouputmode_select(struct hdmi *hdmi, int edid_ok)
1157 {
1158         struct list_head *head = &hdmi->edid.modelist;
1159         struct fb_monspecs *specs = hdmi->edid.specs;
1160         struct fb_videomode *modedb = NULL, *mode = NULL;
1161         int i, pixclock, feature = hdmi->property->feature;
1162
1163         if (edid_ok != HDMI_ERROR_SUCESS) {
1164                 dev_err(hdmi->dev, "warning: EDID error, assume sink as HDMI !!!!");
1165                 hdmi->edid.status = -1;
1166                 hdmi->edid.sink_hdmi = 1;
1167                 hdmi->edid.baseaudio_support = 1;
1168                 hdmi->edid.ycbcr444 = 0;
1169                 hdmi->edid.ycbcr422 = 0;
1170         }
1171
1172         if (head->next == head) {
1173                 dev_info(hdmi->dev,
1174                          "warning: no CEA video mode parsed from EDID !!!!\n");
1175                 /* If EDID get error, list all system supported mode.
1176                  * If output mode is set to DVI and EDID is ok, check
1177                  * the output timing.
1178                  */
1179                 if (hdmi->edid.sink_hdmi == 0 && specs && specs->modedb_len) {
1180                         /* Get max resolution timing */
1181                         modedb = &specs->modedb[0];
1182                         for (i = 0; i < specs->modedb_len; i++) {
1183                                 if (specs->modedb[i].xres > modedb->xres)
1184                                         modedb = &specs->modedb[i];
1185                                 else if (specs->modedb[i].xres ==
1186                                          modedb->xres &&
1187                                          specs->modedb[i].yres > modedb->yres)
1188                                         modedb = &specs->modedb[i];
1189                         }
1190                         /* For some monitor, the max pixclock read from EDID
1191                          * is smaller than the clock of max resolution mode
1192                          * supported. We fix it.
1193                          */
1194                         pixclock = PICOS2KHZ(modedb->pixclock);
1195                         pixclock /= 250;
1196                         pixclock *= 250;
1197                         pixclock *= 1000;
1198                         if (pixclock == 148250000)
1199                                 pixclock = 148500000;
1200                         if (pixclock > specs->dclkmax)
1201                                 specs->dclkmax = pixclock;
1202                 }
1203
1204                 for (i = 0; i < ARRAY_SIZE(hdmi_mode); i++) {
1205                         mode = (struct fb_videomode *)&(hdmi_mode[i].mode);
1206                         if (modedb) {
1207                                 if ((mode->pixclock < specs->dclkmin) ||
1208                                     (mode->pixclock > specs->dclkmax) ||
1209                                     (mode->refresh < specs->vfmin) ||
1210                                     (mode->refresh > specs->vfmax) ||
1211                                     (mode->xres > modedb->xres) ||
1212                                     (mode->yres > modedb->yres))
1213                                         continue;
1214                         } else {
1215                                 /* If there is no valid information in EDID,
1216                                  * just list common hdmi foramt.
1217                                  */
1218                                 if (mode->xres > 3840 ||
1219                                     mode->refresh < 50 ||
1220                                     (mode->vmode & FB_VMODE_INTERLACED) ||
1221                                     hdmi_mode[i].vic & HDMI_VIDEO_DMT)
1222                                         continue;
1223                         }
1224                         if ((feature & SUPPORT_TMDS_600M) == 0 &&
1225                             mode->pixclock > 340000000)
1226                                 continue;
1227                         if ((feature & SUPPORT_4K) == 0 &&
1228                             mode->xres >= 3840)
1229                                 continue;
1230                         if ((feature & SUPPORT_4K_4096) == 0 &&
1231                             mode->xres == 4096)
1232                                 continue;
1233                         if ((feature & SUPPORT_1080I) == 0 &&
1234                             mode->xres == 1920 &&
1235                             (mode->vmode & FB_VMODE_INTERLACED))
1236                                 continue;
1237                         if ((feature & SUPPORT_480I_576I) == 0 &&
1238                             mode->xres == 720 &&
1239                             (mode->vmode & FB_VMODE_INTERLACED))
1240                                 continue;
1241                         hdmi_add_videomode(mode, head);
1242                 }
1243         } else {
1244                 /* There are some video mode is not defined in EDID extend
1245                  * block, so we need to check first block data.
1246                  */
1247                 if (specs && specs->modedb_len) {
1248                         for (i = 0; i < specs->modedb_len; i++) {
1249                                 modedb = &specs->modedb[i];
1250                                 pixclock = hdmi_videomode_to_vic(modedb);
1251                                 if (pixclock)
1252                                         hdmi_add_vic(pixclock, head);
1253                         }
1254                 }
1255                 hdmi_sort_modelist(&hdmi->edid, hdmi->property->feature);
1256         }
1257
1258         return HDMI_ERROR_SUCESS;
1259 }
1260
1261 /**
1262  * hdmi_videomode_to_vic: transverse video mode to vic
1263  * @vmode: videomode to transverse
1264  *
1265  */
1266 int hdmi_videomode_to_vic(struct fb_videomode *vmode)
1267 {
1268         struct fb_videomode *mode;
1269         unsigned int vic = 0;
1270         int i = 0;
1271
1272         for (i = 0; i < ARRAY_SIZE(hdmi_mode); i++) {
1273                 mode = (struct fb_videomode *)&(hdmi_mode[i].mode);
1274                 if (vmode->vmode == mode->vmode &&
1275                     vmode->refresh == mode->refresh &&
1276                     vmode->xres == mode->xres &&
1277                     vmode->yres == mode->yres &&
1278                     vmode->left_margin == mode->left_margin &&
1279                     vmode->right_margin == mode->right_margin &&
1280                     vmode->upper_margin == mode->upper_margin &&
1281                     vmode->lower_margin == mode->lower_margin &&
1282                     vmode->hsync_len == mode->hsync_len &&
1283                     vmode->vsync_len == mode->vsync_len) {
1284                         vic = hdmi_mode[i].vic;
1285                         break;
1286                 }
1287         }
1288         return vic;
1289 }
1290
1291 /**
1292  * hdmi_vic2timing: transverse vic mode to video timing
1293  * @vmode: vic to transverse
1294  *
1295  */
1296 const struct hdmi_video_timing *hdmi_vic2timing(int vic)
1297 {
1298         int i;
1299
1300         if (vic == 0)
1301                 return NULL;
1302
1303         for (i = 0; i < ARRAY_SIZE(hdmi_mode); i++) {
1304                 if (hdmi_mode[i].vic == vic || hdmi_mode[i].vic_2nd == vic)
1305                         return &(hdmi_mode[i]);
1306         }
1307         return NULL;
1308 }
1309
1310 /**
1311  * hdmi_vic_to_videomode: transverse vic mode to video mode
1312  * @vmode: vic to transverse
1313  *
1314  */
1315 const struct fb_videomode *hdmi_vic_to_videomode(int vic)
1316 {
1317         int i, vid;
1318
1319         if (vic == 0)
1320                 return NULL;
1321         else if (vic & HDMI_VIDEO_DMT)
1322                 vid = vic;
1323         else
1324                 vid = vic & HDMI_VIC_MASK;
1325         for (i = 0; i < ARRAY_SIZE(hdmi_mode); i++) {
1326                 if (hdmi_mode[i].vic == vid ||
1327                     hdmi_mode[i].vic_2nd == vid)
1328                         return &hdmi_mode[i].mode;
1329         }
1330         return NULL;
1331 }
1332
1333 /**
1334  * hdmi_init_modelist: initial hdmi mode list
1335  * @hdmi:
1336  *
1337  * NOTES:
1338  *
1339  */
1340 void hdmi_init_modelist(struct hdmi *hdmi)
1341 {
1342         int i, feature;
1343         struct list_head *head = &hdmi->edid.modelist;
1344
1345         feature = hdmi->property->feature;
1346         INIT_LIST_HEAD(&hdmi->edid.modelist);
1347         for (i = 0; i < ARRAY_SIZE(hdmi_mode); i++) {
1348                 if (hdmi_mode[i].vic & HDMI_VIDEO_DMT)
1349                         continue;
1350                 if ((feature & SUPPORT_TMDS_600M) == 0 &&
1351                     hdmi_mode[i].mode.pixclock > 340000000)
1352                         continue;
1353                 if ((feature & SUPPORT_4K) == 0 &&
1354                     hdmi_mode[i].mode.xres >= 3840)
1355                         continue;
1356                 if ((feature & SUPPORT_4K_4096) == 0 &&
1357                     hdmi_mode[i].mode.xres == 4096)
1358                         continue;
1359                 if ((feature & SUPPORT_1080I) == 0 &&
1360                     hdmi_mode[i].mode.xres == 1920 &&
1361                     (hdmi_mode[i].mode.vmode & FB_VMODE_INTERLACED))
1362                         continue;
1363                 if ((feature & SUPPORT_480I_576I) == 0 &&
1364                     hdmi_mode[i].mode.xres == 720 &&
1365                     (hdmi_mode[i].mode.vmode & FB_VMODE_INTERLACED))
1366                         continue;
1367                 hdmi_add_videomode(&(hdmi_mode[i].mode), head);
1368         }
1369 }