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                 .mode = {
 776                         .name = "1440x1280@60Hz",
 777                         .refresh = 60,
 778                         .xres = 1440,
 779                         .yres = 1280,
 780                         .pixclock = 148500000,
 781                         .left_margin = 84,
 782                         .right_margin = 360,
 783                         .upper_margin = 8,
 784                         .lower_margin = 10,
 785                         .hsync_len = 20,
 786                         .vsync_len = 2,
 787                         .sync = 0,
 788                         .vmode = 0,
 789                         .flag = 0,
 790                 },
 791                 .vic = HDMI_VIDEO_DISCRETE_VR | 1,
 792                 .vic_2nd = 0,
 793                 .pixelrepeat = 1,
 794                 .interface = OUT_P888,
 795         },
 796         {
 797                 /* AUO 3.81 */
 798                 .mode = {
 799                         .name = "2160x1200@75Hz",
 800                         .refresh = 75,
 801                         .xres = 2160,
 802                         .yres = 1200,
 803                         .pixclock = 245000000,
 804                         .left_margin = 100,
 805                         .right_margin = 420,
 806                         .upper_margin = 3,
 807                         .lower_margin = 6,
 808                         .hsync_len = 32,
 809                         .vsync_len = 3,
 810                         .sync = 0,
 811                         .vmode = 0,
 812                         .flag = 0,
 813                 },
 814                 .vic = HDMI_VIDEO_DISCRETE_VR | 3,
 815                 .vic_2nd = 0,
 816                 .pixelrepeat = 1,
 817                 .interface = OUT_P888,
 818         },
 819         {
 820                 /* sharp 2.89 */
 821                 .mode = {
 822                         .name = "2880x1440@75Hz",
 823                         .refresh = 75,
 824                         .xres = 2880,
 825                         .yres = 1440,
 826                         .pixclock = 340000000,
 827                         .left_margin = 100,
 828                         .right_margin = 50,
 829                         .upper_margin = 8,
 830                         .lower_margin = 6,
 831                         .hsync_len = 50,
 832                         .vsync_len = 1,
 833                         .sync = 0,
 834                         .vmode = 0,
 835                         .flag = 0,
 836                 },
 837                 .vic = HDMI_VIDEO_DISCRETE_VR | 4,
 838                 .vic_2nd = 0,
 839                 .pixelrepeat = 1,
 840                 .interface = OUT_P888,
 841         },
 842         {
 843                 /* RAYKEN 5.46 */
 844                 .mode = {
 845                         .name = "1440x2560@60Hz",
 846                         .refresh = 60,
 847                         .xres = 1440,
 848                         .yres = 2560,
 849                         .pixclock = 268500000,
 850                         .left_margin = 50,
 851                         .right_margin = 200,
 852                         .upper_margin = 20,
 853                         .lower_margin = 20,
 854                         .hsync_len = 20,
 855                         .vsync_len = 10,
 856                         .sync = 0,
 857                         .vmode = 0,
 858                         .flag = 0,
 859                 },
 860                 .vic = HDMI_VIDEO_DISCRETE_VR | 5,
 861                 .vic_2nd = 0,
 862                 .pixelrepeat = 1,
 863                 .interface = OUT_P888,
 864         },
 865 };
 866
 867 static int hdmi_set_info(struct rk_screen *screen, struct hdmi *hdmi)
 868 {
 869         int i, vic;
 870         struct fb_videomode *mode;
 871
 872         if (!screen || !hdmi)
 873                 return HDMI_ERROR_FALSE;
 874
 875         if (hdmi->vic == 0)
 876                 hdmi->vic = hdmi->property->defaultmode;
 877
 878         if ((hdmi->vic & HDMI_VIDEO_DMT) || (hdmi->vic & HDMI_VIDEO_DISCRETE_VR))
 879                 vic = hdmi->vic;
 880         else
 881                 vic = hdmi->vic & HDMI_VIC_MASK;
 882         for (i = 0; i < ARRAY_SIZE(hdmi_mode); i++) {
 883                 if (hdmi_mode[i].vic == vic ||
 884                     hdmi_mode[i].vic_2nd == vic)
 885                         break;
 886         }
 887         if (i == ARRAY_SIZE(hdmi_mode))
 888                 return HDMI_ERROR_FALSE;
 889
 890         memset(screen, 0, sizeof(struct rk_screen));
 891
 892         /* screen type & face */
 893         screen->type = SCREEN_HDMI;
 894         if (hdmi->video.color_input == HDMI_COLOR_RGB_0_255)
 895                 screen->color_mode = COLOR_RGB;
 896         else
 897                 screen->color_mode = COLOR_YCBCR;
 898         if (hdmi->vic & HDMI_VIDEO_YUV420) {
 899                 if (hdmi->video.color_output_depth == 10)
 900                         screen->face = OUT_YUV_420_10BIT;
 901                 else
 902                         screen->face = OUT_YUV_420;
 903         } else {
 904                 if (hdmi->video.color_output_depth == 10)
 905                         screen->face = OUT_P101010;
 906                 else
 907                         screen->face = hdmi_mode[i].interface;
 908         }
 909         screen->pixelrepeat = hdmi_mode[i].pixelrepeat - 1;
 910         mode = (struct fb_videomode *)&hdmi_mode[i].mode;
 911
 912         screen->mode = *mode;
 913         if (hdmi->video.format_3d == HDMI_3D_FRAME_PACKING) {
 914                 screen->mode.pixclock = 2 * mode->pixclock;
 915                 if (mode->vmode == 0) {
 916                         screen->mode.yres = 2 * mode->yres +
 917                                         mode->upper_margin +
 918                                         mode->lower_margin +
 919                                         mode->vsync_len;
 920                 } else {
 921                         screen->mode.yres = 2 * mode->yres +
 922                                             3 * (mode->upper_margin +
 923                                                  mode->lower_margin +
 924                                                  mode->vsync_len) + 2;
 925                         screen->mode.vmode = 0;
 926                 }
 927         }
 928         /* Pin polarity */
 929         if (FB_SYNC_HOR_HIGH_ACT & mode->sync)
 930                 screen->pin_hsync = 1;
 931         else
 932                 screen->pin_hsync = 0;
 933         if (FB_SYNC_VERT_HIGH_ACT & mode->sync)
 934                 screen->pin_vsync = 1;
 935         else
 936                 screen->pin_vsync = 0;
 937
 938         screen->pin_den = 0;
 939         screen->pin_dclk = 1;
 940
 941         /* Swap rule */
 942         if (hdmi->soctype > HDMI_SOC_RK312X &&
 943             screen->color_mode > COLOR_RGB &&
 944             (screen->face == OUT_P888 ||
 945              screen->face == OUT_P101010))
 946                 screen->swap_rb = 1;
 947         else
 948                 screen->swap_rb = 0;
 949         screen->swap_rg = 0;
 950         screen->swap_gb = 0;
 951         screen->swap_delta = 0;
 952         screen->swap_dumy = 0;
 953
 954         /* Operation function*/
 955         screen->init = NULL;
 956         screen->standby = NULL;
 957
 958         screen->overscan.left = hdmi->xscale;
 959         screen->overscan.top = hdmi->yscale;
 960         screen->overscan.right = hdmi->xscale;
 961         screen->overscan.bottom = hdmi->yscale;
 962         return 0;
 963 }
 964
 965 /**
 966  * hdmi_find_best_mode: find the video mode nearest to input vic
 967  * @hdmi:
 968  * @vic: input vic
 969  *
 970  * NOTES:
 971  * If vic is zero, return the high resolution video mode vic.
 972  */
 973 int hdmi_find_best_mode(struct hdmi *hdmi, int vic)
 974 {
 975         struct list_head *pos, *head = &hdmi->edid.modelist;
 976         struct display_modelist *modelist = NULL;
 977         int found = 0;
 978
 979         if (vic) {
 980                 list_for_each(pos, head) {
 981                         modelist =
 982                                 list_entry(pos,
 983                                            struct display_modelist, list);
 984                         if (modelist->vic == vic) {
 985                                 found = 1;
 986                                 break;
 987                         }
 988                 }
 989         }
 990         if ((!vic || !found) && head->next != head) {
 991                 /* If parse edid error, we select default mode; */
 992                 if (hdmi->edid.specs &&
 993                     hdmi->edid.specs->modedb_len)
 994                         modelist = list_entry(head->next,
 995                                               struct display_modelist, list);
 996                 else
 997                         return hdmi->property->defaultmode;
 998         }
 999
1000         if (modelist)
1001                 return modelist->vic;
1002         else
1003                 return 0;
1004 }
1005
1006 /**
1007  * hdmi_set_lcdc: switch lcdc mode to required video mode
1008  * @hdmi:
1009  *
1010  * NOTES:
1011  *
1012  */
1013 int hdmi_set_lcdc(struct hdmi *hdmi)
1014 {
1015         int rc = 0;
1016         struct rk_screen screen;
1017
1018         rc = hdmi_set_info(&screen, hdmi);
1019         if (!rc)
1020                 rk_fb_switch_screen(&screen, 1, hdmi->lcdc->id);
1021         return rc;
1022 }
1023
1024 /**
1025  * hdmi_videomode_compare - compare 2 videomodes
1026  * @mode1: first videomode
1027  * @mode2: second videomode
1028  *
1029  * RETURNS:
1030  * 1 if mode1 > mode2, 0 if mode1 = mode2, -1 mode1 < mode2
1031  */
1032 static int hdmi_videomode_compare(const struct fb_videomode *mode1,
1033                                   const struct fb_videomode *mode2)
1034 {
1035         if (mode1->xres > mode2->xres)
1036                 return 1;
1037
1038         if (mode1->xres == mode2->xres) {
1039                 if (mode1->yres > mode2->yres)
1040                         return 1;
1041                 if (mode1->yres == mode2->yres) {
1042                         if (mode1->vmode < mode2->vmode)
1043                                 return 1;
1044                         if (mode1->pixclock > mode2->pixclock)
1045                                 return 1;
1046                         if (mode1->pixclock == mode2->pixclock) {
1047                                 if (mode1->refresh > mode2->refresh)
1048                                         return 1;
1049                                 if (mode1->refresh == mode2->refresh) {
1050                                         if (mode2->flag > mode1->flag)
1051                                                 return 1;
1052                                         if (mode2->flag < mode1->flag)
1053                                                 return -1;
1054                                         if (mode2->vmode > mode1->vmode)
1055                                                 return 1;
1056                                         if (mode2->vmode == mode1->vmode)
1057                                                 return 0;
1058                                 }
1059                         }
1060                 }
1061         }
1062         return -1;
1063 }
1064
1065 /**
1066  * hdmi_add_vic - add entry to modelist according vic
1067  * @vic: vic to be added
1068  * @head: struct list_head of modelist
1069  *
1070  * NOTES:
1071  * Will only add unmatched mode entries
1072  */
1073 int hdmi_add_vic(int vic, struct list_head *head)
1074 {
1075         struct list_head *pos;
1076         struct display_modelist *modelist;
1077         int found = 0, v;
1078
1079         /*pr_info("%s vic %d\n", __FUNCTION__, vic);*/
1080         if (vic == 0)
1081                 return -1;
1082
1083         list_for_each(pos, head) {
1084                 modelist = list_entry(pos, struct display_modelist, list);
1085                 v = modelist->vic;
1086                 if (v == vic) {
1087                         found = 1;
1088                         break;
1089                 }
1090         }
1091         if (!found) {
1092                 modelist = kmalloc(sizeof(*modelist),
1093                                    GFP_KERNEL);
1094
1095                 if (!modelist)
1096                         return -ENOMEM;
1097                 memset(modelist, 0, sizeof(struct display_modelist));
1098                 modelist->vic = vic;
1099                 list_add_tail(&modelist->list, head);
1100         }
1101         return 0;
1102 }
1103
1104 /**
1105  * hdmi_add_videomode: adds videomode entry to modelist
1106  * @mode: videomode to be added
1107  * @head: struct list_head of modelist
1108  *
1109  * NOTES:
1110  * Will only add unmatched mode entries
1111  */
1112 static int hdmi_add_videomode(const struct fb_videomode *mode,
1113                               struct list_head *head)
1114 {
1115         struct list_head *pos;
1116         struct display_modelist *modelist, *modelist_new;
1117         struct fb_videomode *m;
1118         int i, found = 0;
1119
1120         for (i = 0; i < ARRAY_SIZE(hdmi_mode); i++) {
1121                 m = (struct fb_videomode *)&hdmi_mode[i].mode;
1122                 if (fb_mode_is_equal(m, mode)) {
1123                         found = 1;
1124                         break;
1125                 }
1126         }
1127
1128         if (found) {
1129                 list_for_each(pos, head) {
1130                         modelist = list_entry(pos,
1131                                               struct display_modelist, list);
1132                         m = &modelist->mode;
1133                         if (fb_mode_is_equal(m, mode))
1134                                 return 0;
1135                         else if (hdmi_videomode_compare(m, mode) == -1)
1136                                 break;
1137                 }
1138
1139                 modelist_new = kmalloc(sizeof(*modelist_new), GFP_KERNEL);
1140                 if (!modelist_new)
1141                         return -ENOMEM;
1142                 memset(modelist_new, 0, sizeof(struct display_modelist));
1143                 modelist_new->mode = hdmi_mode[i].mode;
1144                 modelist_new->vic = hdmi_mode[i].vic;
1145                 list_add_tail(&modelist_new->list, pos);
1146         }
1147
1148         return 0;
1149 }
1150
1151 /**
1152  * hdmi_sort_modelist: sort modelist of edid
1153  * @edid: edid to be sort
1154  */
1155 static void hdmi_sort_modelist(struct hdmi_edid *edid, int feature)
1156 {
1157         struct list_head *pos, *pos_new;
1158         struct list_head head_new, *head = &edid->modelist;
1159         struct display_modelist *modelist, *modelist_new, *modelist_n;
1160         struct fb_videomode *m, *m_new;
1161         int i, compare, vic;
1162
1163         INIT_LIST_HEAD(&head_new);
1164         list_for_each(pos, head) {
1165                 modelist = list_entry(pos, struct display_modelist, list);
1166                 /*pr_info("%s vic %d\n", __function__, modelist->vic);*/
1167                 for (i = 0; i < ARRAY_SIZE(hdmi_mode); i++) {
1168                         if ((modelist->vic & HDMI_VIDEO_DMT) || (modelist->vic & HDMI_VIDEO_DISCRETE_VR)) {
1169                                 if (feature & (SUPPORT_VESA_DMT | SUPPORT_RK_DISCRETE_VR))
1170                                         vic = modelist->vic;
1171                                 else
1172                                         continue;
1173                         } else {
1174                                 vic = modelist->vic & HDMI_VIC_MASK;
1175                         }
1176                         if (vic == hdmi_mode[i].vic ||
1177                             vic == hdmi_mode[i].vic_2nd) {
1178                                 if ((feature & SUPPORT_4K) == 0 &&
1179                                     hdmi_mode[i].mode.xres >= 3840)
1180                                         continue;
1181                                 if ((feature & SUPPORT_4K_4096) == 0 &&
1182                                     hdmi_mode[i].mode.xres == 4096)
1183                                         continue;
1184                                 if ((feature & SUPPORT_TMDS_600M) == 0 &&
1185                                     !(modelist->vic & HDMI_VIDEO_YUV420) &&
1186                                     hdmi_mode[i].mode.pixclock > 340000000)
1187                                         continue;
1188                                 if ((modelist->vic & HDMI_VIDEO_YUV420) &&
1189                                     (feature & SUPPORT_YUV420) == 0)
1190                                         continue;
1191                                 if ((feature & SUPPORT_1080I) == 0 &&
1192                                     hdmi_mode[i].mode.xres == 1920 &&
1193                                     (hdmi_mode[i].mode.vmode &
1194                                      FB_VMODE_INTERLACED))
1195                                         continue;
1196                                 if ((feature & SUPPORT_480I_576I) == 0 &&
1197                                     hdmi_mode[i].mode.xres == 720 &&
1198                                     hdmi_mode[i].mode.vmode &
1199                                      FB_VMODE_INTERLACED)
1200                                         continue;
1201                                 modelist->mode = hdmi_mode[i].mode;
1202                                 if (modelist->vic & HDMI_VIDEO_YUV420)
1203                                         modelist->mode.flag = 1;
1204
1205                                 compare = 1;
1206                                 m = (struct fb_videomode *)&modelist->mode;
1207                                 list_for_each(pos_new, &head_new) {
1208                                         modelist_new =
1209                                         list_entry(pos_new,
1210                                                    struct display_modelist,
1211                                                    list);
1212                                         m_new = &modelist_new->mode;
1213                                         compare =
1214                                         hdmi_videomode_compare(m, m_new);
1215                                         if (compare != -1)
1216                                                 break;
1217                                 }
1218                                 if (compare != 0) {
1219                                         modelist_n =
1220                                                 kmalloc(sizeof(*modelist_n),
1221                                                         GFP_KERNEL);
1222                                         if (!modelist_n)
1223                                                 return;
1224                                         *modelist_n = *modelist;
1225                                         list_add_tail(&modelist_n->list,
1226                                                       pos_new);
1227                                 }
1228                                 break;
1229                         }
1230                 }
1231         }
1232         fb_destroy_modelist(head);
1233         if (head_new.next == &head_new) {
1234                 pr_info("There is no available video mode in EDID.\n");
1235                 INIT_LIST_HEAD(&edid->modelist);
1236         } else {
1237                 edid->modelist = head_new;
1238                 edid->modelist.prev->next = &edid->modelist;
1239                 edid->modelist.next->prev = &edid->modelist;
1240         }
1241 }
1242
1243 /**
1244  * hdmi_ouputmode_select - select hdmi transmitter output mode: hdmi or dvi?
1245  * @hdmi: handle of hdmi
1246  * @edid_ok: get EDID data success or not, HDMI_ERROR_SUCCESS means success.
1247  */
1248 int hdmi_ouputmode_select(struct hdmi *hdmi, int edid_ok)
1249 {
1250         struct list_head *head = &hdmi->edid.modelist;
1251         struct fb_monspecs *specs = hdmi->edid.specs;
1252         struct fb_videomode *modedb = NULL, *mode = NULL;
1253         int i, pixclock, feature = hdmi->property->feature;
1254
1255         if (edid_ok != HDMI_ERROR_SUCCESS) {
1256                 dev_err(hdmi->dev, "warning: EDID error, assume sink as HDMI !!!!");
1257                 hdmi->edid.status = -1;
1258                 hdmi->edid.sink_hdmi = 1;
1259                 hdmi->edid.baseaudio_support = 1;
1260                 hdmi->edid.ycbcr444 = 0;
1261                 hdmi->edid.ycbcr422 = 0;
1262         }
1263
1264         if (head->next == head) {
1265                 dev_info(hdmi->dev,
1266                          "warning: no CEA video mode parsed from EDID !!!!\n");
1267                 /* If EDID get error, list all system supported mode.
1268                  * If output mode is set to DVI and EDID is ok, check
1269                  * the output timing.
1270                  */
1271                 if (hdmi->edid.sink_hdmi == 0 && specs && specs->modedb_len) {
1272                         /* Get max resolution timing */
1273                         modedb = &specs->modedb[0];
1274                         for (i = 0; i < specs->modedb_len; i++) {
1275                                 if (specs->modedb[i].xres > modedb->xres)
1276                                         modedb = &specs->modedb[i];
1277                                 else if (specs->modedb[i].xres ==
1278                                          modedb->xres &&
1279                                          specs->modedb[i].yres > modedb->yres)
1280                                         modedb = &specs->modedb[i];
1281                         }
1282                         /* For some monitor, the max pixclock read from EDID
1283                          * is smaller than the clock of max resolution mode
1284                          * supported. We fix it.
1285                          */
1286                         pixclock = PICOS2KHZ(modedb->pixclock);
1287                         pixclock /= 250;
1288                         pixclock *= 250;
1289                         pixclock *= 1000;
1290                         if (pixclock == 148250000)
1291                                 pixclock = 148500000;
1292                         if (pixclock > specs->dclkmax)
1293                                 specs->dclkmax = pixclock;
1294                 }
1295
1296                 for (i = 0; i < ARRAY_SIZE(hdmi_mode); i++) {
1297                         mode = (struct fb_videomode *)&hdmi_mode[i].mode;
1298                         if (modedb) {
1299                                 if ((mode->pixclock < specs->dclkmin) ||
1300                                     (mode->pixclock > specs->dclkmax) ||
1301                                     (mode->refresh < specs->vfmin) ||
1302                                     (mode->refresh > specs->vfmax) ||
1303                                     (mode->xres > modedb->xres) ||
1304                                     (mode->yres > modedb->yres))
1305                                         continue;
1306                         } else {
1307                                 /* If there is no valid information in EDID,
1308                                  * just list common hdmi foramt.
1309                                  */
1310                                 if (mode->xres > 3840 ||
1311                                     mode->refresh < 50 ||
1312                                     (mode->vmode & FB_VMODE_INTERLACED) ||
1313                                     hdmi_mode[i].vic & HDMI_VIDEO_DMT ||
1314                                     hdmi_mode[i].vic & HDMI_VIDEO_DISCRETE_VR)
1315                                         continue;
1316                         }
1317                         if ((feature & SUPPORT_TMDS_600M) == 0 &&
1318                             mode->pixclock > 340000000)
1319                                 continue;
1320                         if ((feature & SUPPORT_4K) == 0 &&
1321                             mode->xres >= 3840)
1322                                 continue;
1323                         if ((feature & SUPPORT_4K_4096) == 0 &&
1324                             mode->xres == 4096)
1325                                 continue;
1326                         if ((feature & SUPPORT_1080I) == 0 &&
1327                             mode->xres == 1920 &&
1328                             (mode->vmode & FB_VMODE_INTERLACED))
1329                                 continue;
1330                         if ((feature & SUPPORT_480I_576I) == 0 &&
1331                             mode->xres == 720 &&
1332                             (mode->vmode & FB_VMODE_INTERLACED))
1333                                 continue;
1334                         hdmi_add_videomode(mode, head);
1335                 }
1336         } else {
1337                 /* There are some video mode is not defined in EDID extend
1338                  * block, so we need to check first block data.
1339                  */
1340                 if (specs && specs->modedb_len) {
1341                         for (i = 0; i < specs->modedb_len; i++) {
1342                                 modedb = &specs->modedb[i];
1343                                 pixclock = hdmi_videomode_to_vic(modedb);
1344                                 if (pixclock)
1345                                         hdmi_add_vic(pixclock, head);
1346                         }
1347                 }
1348                 hdmi_sort_modelist(&hdmi->edid, hdmi->property->feature);
1349         }
1350
1351         return HDMI_ERROR_SUCCESS;
1352 }
1353
1354 /**
1355  * hdmi_videomode_to_vic: transverse video mode to vic
1356  * @vmode: videomode to transverse
1357  *
1358  */
1359 int hdmi_videomode_to_vic(struct fb_videomode *vmode)
1360 {
1361         struct fb_videomode *mode;
1362         unsigned int vic = 0;
1363         int i = 0;
1364
1365         for (i = 0; i < ARRAY_SIZE(hdmi_mode); i++) {
1366                 mode = (struct fb_videomode *)&hdmi_mode[i].mode;
1367                 if (vmode->vmode == mode->vmode &&
1368                     vmode->refresh == mode->refresh &&
1369                     vmode->xres == mode->xres &&
1370                     vmode->yres == mode->yres &&
1371                     vmode->left_margin == mode->left_margin &&
1372                     vmode->right_margin == mode->right_margin &&
1373                     vmode->upper_margin == mode->upper_margin &&
1374                     vmode->lower_margin == mode->lower_margin &&
1375                     vmode->hsync_len == mode->hsync_len &&
1376                     vmode->vsync_len == mode->vsync_len) {
1377                         vic = hdmi_mode[i].vic;
1378                         break;
1379                 }
1380         }
1381         return vic;
1382 }
1383
1384 /**
1385  * hdmi_vic2timing: transverse vic mode to video timing
1386  * @vmode: vic to transverse
1387  *
1388  */
1389 const struct hdmi_video_timing *hdmi_vic2timing(int vic)
1390 {
1391         int i;
1392
1393         if (vic == 0)
1394                 return NULL;
1395
1396         for (i = 0; i < ARRAY_SIZE(hdmi_mode); i++) {
1397                 if (hdmi_mode[i].vic == vic || hdmi_mode[i].vic_2nd == vic)
1398                         return &hdmi_mode[i];
1399         }
1400         return NULL;
1401 }
1402
1403 /**
1404  * hdmi_vic_to_videomode: transverse vic mode to video mode
1405  * @vmode: vic to transverse
1406  *
1407  */
1408 const struct fb_videomode *hdmi_vic_to_videomode(int vic)
1409 {
1410         int i, vid;
1411
1412         if (vic == 0)
1413                 return NULL;
1414         else if ((vic & HDMI_VIDEO_DMT) || (vic & HDMI_VIDEO_DISCRETE_VR))
1415                 vid = vic;
1416         else
1417                 vid = vic & HDMI_VIC_MASK;
1418         for (i = 0; i < ARRAY_SIZE(hdmi_mode); i++) {
1419                 if (hdmi_mode[i].vic == vid ||
1420                     hdmi_mode[i].vic_2nd == vid)
1421                         return &hdmi_mode[i].mode;
1422         }
1423         return NULL;
1424 }
1425
1426 /**
1427  * hdmi_init_modelist: initial hdmi mode list
1428  * @hdmi:
1429  *
1430  * NOTES:
1431  *
1432  */
1433 void hdmi_init_modelist(struct hdmi *hdmi)
1434 {
1435         int i, feature;
1436         struct list_head *head = &hdmi->edid.modelist;
1437
1438         feature = hdmi->property->feature;
1439         INIT_LIST_HEAD(&hdmi->edid.modelist);
1440         for (i = 0; i < ARRAY_SIZE(hdmi_mode); i++) {
1441                 if ((hdmi_mode[i].vic & HDMI_VIDEO_DMT) || (hdmi_mode[i].vic & HDMI_VIDEO_DISCRETE_VR))
1442                         continue;
1443                 if ((feature & SUPPORT_TMDS_600M) == 0 &&
1444                     hdmi_mode[i].mode.pixclock > 340000000)
1445                         continue;
1446                 if ((feature & SUPPORT_4K) == 0 &&
1447                     hdmi_mode[i].mode.xres >= 3840)
1448                         continue;
1449                 if ((feature & SUPPORT_4K_4096) == 0 &&
1450                     hdmi_mode[i].mode.xres == 4096)
1451                         continue;
1452                 if ((feature & SUPPORT_1080I) == 0 &&
1453                     hdmi_mode[i].mode.xres == 1920 &&
1454                     (hdmi_mode[i].mode.vmode & FB_VMODE_INTERLACED))
1455                         continue;
1456                 if ((feature & SUPPORT_480I_576I) == 0 &&
1457                     hdmi_mode[i].mode.xres == 720 &&
1458                     (hdmi_mode[i].mode.vmode & FB_VMODE_INTERLACED))
1459                         continue;
1460                 hdmi_add_videomode(&hdmi_mode[i].mode, head);
1461         }
1462 }