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                 /* samsung */
 867                 .mode = {
 868                         .name = "1440x2560@70Hz",
 869                         .refresh = 70,
 870                         .xres = 1440,
 871                         .yres = 2560,
 872                         .pixclock = 285000000,
 873                         .left_margin = 40,
 874                         .right_margin = 80,
 875                         .upper_margin = 2,
 876                         .lower_margin = 6,
 877                         .hsync_len = 20,
 878                         .vsync_len = 8,
 879                         .sync = 0,
 880                         .vmode = 0,
 881                         .flag = 0,
 882                 },
 883                 .vic = HDMI_VIDEO_DISCRETE_VR | 6,
 884                 .vic_2nd = 0,
 885                 .pixelrepeat = 1,
 886                 .interface = OUT_P888,
 887         },
 888 };
 889
 890 static int hdmi_set_info(struct rk_screen *screen, struct hdmi *hdmi)
 891 {
 892         int i, vic;
 893         struct fb_videomode *mode;
 894
 895         if (!screen || !hdmi)
 896                 return HDMI_ERROR_FALSE;
 897
 898         if (hdmi->vic == 0)
 899                 hdmi->vic = hdmi->property->defaultmode;
 900
 901         if (hdmi->edid_auto_support) {
 902                 if ((hdmi->vic & HDMI_VIDEO_DMT) ||
 903                     (hdmi->vic & HDMI_VIDEO_DISCRETE_VR)) {
 904                         if (hdmi->prop.value.vic)
 905                                 vic = hdmi->prop.value.vic;
 906                         else
 907                                 vic = hdmi->vic;
 908                 } else {
 909                         vic = hdmi->vic & HDMI_VIC_MASK;
 910                 }
 911         } else {
 912                 if ((hdmi->vic & HDMI_VIDEO_DMT) ||
 913                     (hdmi->vic & HDMI_VIDEO_DISCRETE_VR))
 914                         vic = hdmi->vic;
 915                 else
 916                         vic = hdmi->vic & HDMI_VIC_MASK;
 917         }
 918
 919         for (i = 0; i < ARRAY_SIZE(hdmi_mode); i++) {
 920                 if (hdmi_mode[i].vic == vic ||
 921                     hdmi_mode[i].vic_2nd == vic)
 922                         break;
 923         }
 924         if (i == ARRAY_SIZE(hdmi_mode))
 925                 return HDMI_ERROR_FALSE;
 926
 927         memset(screen, 0, sizeof(struct rk_screen));
 928
 929         /* screen type & face */
 930         screen->type = SCREEN_HDMI;
 931         if (hdmi->video.color_input == HDMI_COLOR_RGB_0_255)
 932                 screen->color_mode = COLOR_RGB;
 933         else
 934                 screen->color_mode = COLOR_YCBCR;
 935         if (hdmi->vic & HDMI_VIDEO_YUV420) {
 936                 if (hdmi->video.color_output_depth == 10)
 937                         screen->face = OUT_YUV_420_10BIT;
 938                 else
 939                         screen->face = OUT_YUV_420;
 940         } else {
 941                 if (hdmi->video.color_output_depth == 10)
 942                         screen->face = OUT_P101010;
 943                 else
 944                         screen->face = hdmi_mode[i].interface;
 945         }
 946         screen->pixelrepeat = hdmi_mode[i].pixelrepeat - 1;
 947         mode = (struct fb_videomode *)&hdmi_mode[i].mode;
 948
 949         screen->mode = *mode;
 950         if (hdmi->video.format_3d == HDMI_3D_FRAME_PACKING) {
 951                 screen->mode.pixclock = 2 * mode->pixclock;
 952                 if (mode->vmode == 0) {
 953                         screen->mode.yres = 2 * mode->yres +
 954                                         mode->upper_margin +
 955                                         mode->lower_margin +
 956                                         mode->vsync_len;
 957                 } else {
 958                         screen->mode.yres = 2 * mode->yres +
 959                                             3 * (mode->upper_margin +
 960                                                  mode->lower_margin +
 961                                                  mode->vsync_len) + 2;
 962                         screen->mode.vmode = 0;
 963                 }
 964         }
 965         /* Pin polarity */
 966         if (FB_SYNC_HOR_HIGH_ACT & mode->sync)
 967                 screen->pin_hsync = 1;
 968         else
 969                 screen->pin_hsync = 0;
 970         if (FB_SYNC_VERT_HIGH_ACT & mode->sync)
 971                 screen->pin_vsync = 1;
 972         else
 973                 screen->pin_vsync = 0;
 974
 975         screen->pin_den = 0;
 976         screen->pin_dclk = 1;
 977
 978         /* Swap rule */
 979         if (hdmi->soctype > HDMI_SOC_RK312X &&
 980             screen->color_mode > COLOR_RGB &&
 981             (screen->face == OUT_P888 ||
 982              screen->face == OUT_P101010))
 983                 screen->swap_rb = 1;
 984         else
 985                 screen->swap_rb = 0;
 986         screen->swap_rg = 0;
 987         screen->swap_gb = 0;
 988         screen->swap_delta = 0;
 989         screen->swap_dumy = 0;
 990
 991         /* Operation function*/
 992         screen->init = NULL;
 993         screen->standby = NULL;
 994
 995         screen->overscan.left = hdmi->xscale;
 996         screen->overscan.top = hdmi->yscale;
 997         screen->overscan.right = hdmi->xscale;
 998         screen->overscan.bottom = hdmi->yscale;
 999
1000         screen->width = hdmi->prop.value.width;
1001         screen->height = hdmi->prop.value.height;
1002         pr_info("%s:line=%d %d %d %d %d %d %d %d %d\n",
1003                 __func__, __LINE__, screen->mode.xres, screen->mode.yres,
1004                 screen->mode.left_margin, screen->mode.right_margin,
1005                 screen->mode.upper_margin, screen->mode.lower_margin,
1006                 screen->mode.hsync_len, screen->mode.vsync_len);
1007
1008         return 0;
1009 }
1010
1011 /**
1012  * hdmi_find_best_mode: find the video mode nearest to input vic
1013  * @hdmi:
1014  * @vic: input vic
1015  *
1016  * NOTES:
1017  * If vic is zero, return the high resolution video mode vic.
1018  */
1019 int hdmi_find_best_mode(struct hdmi *hdmi, int vic)
1020 {
1021         struct list_head *pos, *head = &hdmi->edid.modelist;
1022         struct display_modelist *modelist = NULL;
1023         int found = 0;
1024
1025         if (vic) {
1026                 list_for_each(pos, head) {
1027                         modelist =
1028                                 list_entry(pos,
1029                                            struct display_modelist, list);
1030                         if (modelist->vic == vic) {
1031                                 found = 1;
1032                                 break;
1033                         }
1034                 }
1035         }
1036         if ((!vic || !found) && head->next != head) {
1037                 /* If parse edid error, we select default mode; */
1038                 if (hdmi->edid.specs &&
1039                     hdmi->edid.specs->modedb_len)
1040                         modelist = list_entry(head->next,
1041                                               struct display_modelist, list);
1042                 else
1043                         return hdmi->property->defaultmode;
1044         }
1045
1046         if (modelist)
1047                 return modelist->vic;
1048         else
1049                 return 0;
1050 }
1051
1052 /**
1053  * hdmi_set_lcdc: switch lcdc mode to required video mode
1054  * @hdmi:
1055  *
1056  * NOTES:
1057  *
1058  */
1059 int hdmi_set_lcdc(struct hdmi *hdmi)
1060 {
1061         int rc = 0;
1062         struct rk_screen screen;
1063
1064         rc = hdmi_set_info(&screen, hdmi);
1065         if (!rc)
1066                 rk_fb_switch_screen(&screen, 1, hdmi->lcdc->id);
1067         return rc;
1068 }
1069
1070 /**
1071  * hdmi_videomode_compare - compare 2 videomodes
1072  * @mode1: first videomode
1073  * @mode2: second videomode
1074  *
1075  * RETURNS:
1076  * 1 if mode1 > mode2, 0 if mode1 = mode2, -1 mode1 < mode2
1077  */
1078 static int hdmi_videomode_compare(const struct fb_videomode *mode1,
1079                                   const struct fb_videomode *mode2)
1080 {
1081         if (mode1->xres > mode2->xres)
1082                 return 1;
1083
1084         if (mode1->xres == mode2->xres) {
1085                 if (mode1->yres > mode2->yres)
1086                         return 1;
1087                 if (mode1->yres == mode2->yres) {
1088                         if (mode1->vmode < mode2->vmode)
1089                                 return 1;
1090                         if (mode1->pixclock > mode2->pixclock)
1091                                 return 1;
1092                         if (mode1->pixclock == mode2->pixclock) {
1093                                 if (mode1->refresh > mode2->refresh)
1094                                         return 1;
1095                                 if (mode1->refresh == mode2->refresh) {
1096                                         if (mode2->flag > mode1->flag)
1097                                                 return 1;
1098                                         if (mode2->flag < mode1->flag)
1099                                                 return -1;
1100                                         if (mode2->vmode > mode1->vmode)
1101                                                 return 1;
1102                                         if (mode2->vmode == mode1->vmode)
1103                                                 return 0;
1104                                 }
1105                         }
1106                 }
1107         }
1108         return -1;
1109 }
1110
1111 /**
1112  * hdmi_add_vic - add entry to modelist according vic
1113  * @vic: vic to be added
1114  * @head: struct list_head of modelist
1115  *
1116  * NOTES:
1117  * Will only add unmatched mode entries
1118  */
1119 int hdmi_add_vic(int vic, struct list_head *head)
1120 {
1121         struct list_head *pos;
1122         struct display_modelist *modelist;
1123         int found = 0, v;
1124
1125         /*pr_info("%s vic %d\n", __FUNCTION__, vic);*/
1126         if (vic == 0)
1127                 return -1;
1128
1129         list_for_each(pos, head) {
1130                 modelist = list_entry(pos, struct display_modelist, list);
1131                 v = modelist->vic;
1132                 if (v == vic) {
1133                         found = 1;
1134                         break;
1135                 }
1136         }
1137         if (!found) {
1138                 modelist = kmalloc(sizeof(*modelist),
1139                                    GFP_KERNEL);
1140
1141                 if (!modelist)
1142                         return -ENOMEM;
1143                 memset(modelist, 0, sizeof(struct display_modelist));
1144                 modelist->vic = vic;
1145                 list_add_tail(&modelist->list, head);
1146         }
1147         return 0;
1148 }
1149
1150 /**
1151  * hdmi_add_videomode: adds videomode entry to modelist
1152  * @mode: videomode to be added
1153  * @head: struct list_head of modelist
1154  *
1155  * NOTES:
1156  * Will only add unmatched mode entries
1157  */
1158 static int hdmi_add_videomode(const struct fb_videomode *mode,
1159                               struct list_head *head)
1160 {
1161         struct list_head *pos;
1162         struct display_modelist *modelist, *modelist_new;
1163         struct fb_videomode *m;
1164         int i, found = 0;
1165
1166         for (i = 0; i < ARRAY_SIZE(hdmi_mode); i++) {
1167                 m = (struct fb_videomode *)&hdmi_mode[i].mode;
1168                 if (fb_mode_is_equal(m, mode)) {
1169                         found = 1;
1170                         break;
1171                 }
1172         }
1173
1174         if (found) {
1175                 list_for_each(pos, head) {
1176                         modelist = list_entry(pos,
1177                                               struct display_modelist, list);
1178                         m = &modelist->mode;
1179                         if (fb_mode_is_equal(m, mode))
1180                                 return 0;
1181                         else if (hdmi_videomode_compare(m, mode) == -1)
1182                                 break;
1183                 }
1184
1185                 modelist_new = kmalloc(sizeof(*modelist_new), GFP_KERNEL);
1186                 if (!modelist_new)
1187                         return -ENOMEM;
1188                 memset(modelist_new, 0, sizeof(struct display_modelist));
1189                 modelist_new->mode = hdmi_mode[i].mode;
1190                 modelist_new->vic = hdmi_mode[i].vic;
1191                 list_add_tail(&modelist_new->list, pos);
1192         }
1193
1194         return 0;
1195 }
1196
1197 /**
1198  * hdmi_sort_modelist: sort modelist of edid
1199  * @edid: edid to be sort
1200  */
1201 static void hdmi_sort_modelist(struct hdmi_edid *edid, int feature)
1202 {
1203         struct list_head *pos, *pos_new;
1204         struct list_head head_new, *head = &edid->modelist;
1205         struct display_modelist *modelist, *modelist_new, *modelist_n;
1206         struct fb_videomode *m, *m_new;
1207         int i, compare, vic;
1208
1209         INIT_LIST_HEAD(&head_new);
1210         list_for_each(pos, head) {
1211                 modelist = list_entry(pos, struct display_modelist, list);
1212                 /*pr_info("%s vic %d\n", __function__, modelist->vic);*/
1213                 for (i = 0; i < ARRAY_SIZE(hdmi_mode); i++) {
1214                         if ((modelist->vic & HDMI_VIDEO_DMT) || (modelist->vic & HDMI_VIDEO_DISCRETE_VR)) {
1215                                 if (feature & (SUPPORT_VESA_DMT | SUPPORT_RK_DISCRETE_VR))
1216                                         vic = modelist->vic;
1217                                 else
1218                                         continue;
1219                         } else {
1220                                 vic = modelist->vic & HDMI_VIC_MASK;
1221                         }
1222                         if (vic == hdmi_mode[i].vic ||
1223                             vic == hdmi_mode[i].vic_2nd) {
1224                                 if ((feature & SUPPORT_4K) == 0 &&
1225                                     hdmi_mode[i].mode.xres >= 3840)
1226                                         continue;
1227                                 if ((feature & SUPPORT_4K_4096) == 0 &&
1228                                     hdmi_mode[i].mode.xres == 4096)
1229                                         continue;
1230                                 if ((feature & SUPPORT_TMDS_600M) == 0 &&
1231                                     !(modelist->vic & HDMI_VIDEO_YUV420) &&
1232                                     hdmi_mode[i].mode.pixclock > 340000000)
1233                                         continue;
1234                                 if ((modelist->vic & HDMI_VIDEO_YUV420) &&
1235                                     (feature & SUPPORT_YUV420) == 0)
1236                                         continue;
1237                                 if ((feature & SUPPORT_1080I) == 0 &&
1238                                     hdmi_mode[i].mode.xres == 1920 &&
1239                                     (hdmi_mode[i].mode.vmode &
1240                                      FB_VMODE_INTERLACED))
1241                                         continue;
1242                                 if ((feature & SUPPORT_480I_576I) == 0 &&
1243                                     hdmi_mode[i].mode.xres == 720 &&
1244                                     hdmi_mode[i].mode.vmode &
1245                                      FB_VMODE_INTERLACED)
1246                                         continue;
1247                                 modelist->mode = hdmi_mode[i].mode;
1248                                 if (modelist->vic & HDMI_VIDEO_YUV420)
1249                                         modelist->mode.flag = 1;
1250
1251                                 compare = 1;
1252                                 m = (struct fb_videomode *)&modelist->mode;
1253                                 list_for_each(pos_new, &head_new) {
1254                                         modelist_new =
1255                                         list_entry(pos_new,
1256                                                    struct display_modelist,
1257                                                    list);
1258                                         m_new = &modelist_new->mode;
1259                                         compare =
1260                                         hdmi_videomode_compare(m, m_new);
1261                                         if (compare != -1)
1262                                                 break;
1263                                 }
1264                                 if (compare != 0) {
1265                                         modelist_n =
1266                                                 kmalloc(sizeof(*modelist_n),
1267                                                         GFP_KERNEL);
1268                                         if (!modelist_n)
1269                                                 return;
1270                                         *modelist_n = *modelist;
1271                                         list_add_tail(&modelist_n->list,
1272                                                       pos_new);
1273                                 }
1274                                 break;
1275                         }
1276                 }
1277         }
1278         fb_destroy_modelist(head);
1279         if (head_new.next == &head_new) {
1280                 pr_info("There is no available video mode in EDID.\n");
1281                 INIT_LIST_HEAD(&edid->modelist);
1282         } else {
1283                 edid->modelist = head_new;
1284                 edid->modelist.prev->next = &edid->modelist;
1285                 edid->modelist.next->prev = &edid->modelist;
1286         }
1287 }
1288
1289 static int edid_select_prop_value(struct hdmi *hdmi)
1290 {
1291         struct edid_prop_value *prop_value = NULL;
1292         int nstates = 0;
1293         int i, vid, pid, sn, xres, yres, reboot = 0;
1294
1295         prop_value = hdmi->pvalue;
1296         nstates = hdmi->nstates;
1297
1298         if (!prop_value) {
1299                 pr_info("%s:pvalue is NULL\n", __func__);
1300                 return -1;
1301         }
1302
1303         vid = hdmi->edid.value.vid;
1304         pid = hdmi->edid.value.pid;
1305         sn = hdmi->edid.value.sn;
1306         xres = hdmi->edid.value.xres;
1307         yres = hdmi->edid.value.yres;
1308
1309         for (i = 0; i < nstates; i++) {
1310                 if ((prop_value[i].vid == vid) &&
1311                     (prop_value[i].pid == pid) &&
1312                     (prop_value[i].sn == sn) &&
1313                     (prop_value[i].xres == xres) &&
1314                     (prop_value[i].yres == yres)) {
1315                         hdmi->edid.value = prop_value[i];
1316                         hdmi->prop.value = prop_value[i];
1317                         if ((hdmi->prop.valid) &&
1318                             ((hdmi->prop.last_vid != vid) ||
1319                             (hdmi->prop.last_pid != pid) ||
1320                             (hdmi->prop.last_sn != sn) ||
1321                             (hdmi->prop.last_xres != xres) ||
1322                             (hdmi->prop.last_yres != yres))) {
1323                                 reboot = 1;
1324                         } else {
1325                                 reboot = 0;
1326                         }
1327
1328                         hdmi->prop.last_vid = vid;
1329                         hdmi->prop.last_pid = pid;
1330                         hdmi->prop.last_sn = sn;
1331                         hdmi->prop.last_xres = xres;
1332                         hdmi->prop.last_yres = yres;
1333                         hdmi->prop.valid = 1;
1334                         pr_info("%s:i=%d reboot=%d,valid=%d\n",
1335                                 __func__, i, reboot, hdmi->prop.valid);
1336
1337                         break;
1338                 }
1339         }
1340
1341         if (reboot) {
1342                 dev_info(hdmi->dev, "%s:kernel_restart\n", __func__);
1343                 kernel_restart(NULL);
1344         }
1345
1346         return 0;
1347 }
1348
1349 /**
1350  * hdmi_ouputmode_select - select hdmi transmitter output mode: hdmi or dvi?
1351  * @hdmi: handle of hdmi
1352  * @edid_ok: get EDID data success or not, HDMI_ERROR_SUCCESS means success.
1353  */
1354 int hdmi_ouputmode_select(struct hdmi *hdmi, int edid_ok)
1355 {
1356         struct list_head *head = &hdmi->edid.modelist;
1357         struct fb_monspecs *specs = hdmi->edid.specs;
1358         struct fb_videomode *modedb = NULL, *mode = NULL;
1359         int i, pixclock, feature = hdmi->property->feature;
1360
1361         if (edid_ok != HDMI_ERROR_SUCCESS) {
1362                 dev_err(hdmi->dev, "warning: EDID error, assume sink as HDMI !!!!");
1363                 hdmi->edid.status = -1;
1364                 hdmi->edid.sink_hdmi = 1;
1365                 hdmi->edid.baseaudio_support = 1;
1366                 hdmi->edid.ycbcr444 = 0;
1367                 hdmi->edid.ycbcr422 = 0;
1368         }
1369
1370         if (hdmi->edid_auto_support)
1371                 edid_select_prop_value(hdmi);
1372
1373         if (head->next == head) {
1374                 dev_info(hdmi->dev,
1375                          "warning: no CEA video mode parsed from EDID !!!!\n");
1376                 /* If EDID get error, list all system supported mode.
1377                  * If output mode is set to DVI and EDID is ok, check
1378                  * the output timing.
1379                  */
1380                 if (hdmi->edid.sink_hdmi == 0 && specs && specs->modedb_len) {
1381                         /* Get max resolution timing */
1382                         modedb = &specs->modedb[0];
1383                         for (i = 0; i < specs->modedb_len; i++) {
1384                                 if (specs->modedb[i].xres > modedb->xres)
1385                                         modedb = &specs->modedb[i];
1386                                 else if (specs->modedb[i].xres ==
1387                                          modedb->xres &&
1388                                          specs->modedb[i].yres > modedb->yres)
1389                                         modedb = &specs->modedb[i];
1390                         }
1391                         /* For some monitor, the max pixclock read from EDID
1392                          * is smaller than the clock of max resolution mode
1393                          * supported. We fix it.
1394                          */
1395                         pixclock = PICOS2KHZ(modedb->pixclock);
1396                         pixclock /= 250;
1397                         pixclock *= 250;
1398                         pixclock *= 1000;
1399                         if (pixclock == 148250000)
1400                                 pixclock = 148500000;
1401                         if (pixclock > specs->dclkmax)
1402                                 specs->dclkmax = pixclock;
1403                 }
1404
1405                 for (i = 0; i < ARRAY_SIZE(hdmi_mode); i++) {
1406                         mode = (struct fb_videomode *)&hdmi_mode[i].mode;
1407                         if (modedb) {
1408                                 if ((mode->pixclock < specs->dclkmin) ||
1409                                     (mode->pixclock > specs->dclkmax) ||
1410                                     (mode->refresh < specs->vfmin) ||
1411                                     (mode->refresh > specs->vfmax) ||
1412                                     (mode->xres > modedb->xres) ||
1413                                     (mode->yres > modedb->yres))
1414                                         continue;
1415                         } else {
1416                                 /* If there is no valid information in EDID,
1417                                  * just list common hdmi foramt.
1418                                  */
1419                                 if (mode->xres > 3840 ||
1420                                     mode->refresh < 50 ||
1421                                     (mode->vmode & FB_VMODE_INTERLACED) ||
1422                                     hdmi_mode[i].vic & HDMI_VIDEO_DMT ||
1423                                     hdmi_mode[i].vic & HDMI_VIDEO_DISCRETE_VR)
1424                                         continue;
1425                         }
1426                         if ((feature & SUPPORT_TMDS_600M) == 0 &&
1427                             mode->pixclock > 340000000)
1428                                 continue;
1429                         if ((feature & SUPPORT_4K) == 0 &&
1430                             mode->xres >= 3840)
1431                                 continue;
1432                         if ((feature & SUPPORT_4K_4096) == 0 &&
1433                             mode->xres == 4096)
1434                                 continue;
1435                         if ((feature & SUPPORT_1080I) == 0 &&
1436                             mode->xres == 1920 &&
1437                             (mode->vmode & FB_VMODE_INTERLACED))
1438                                 continue;
1439                         if ((feature & SUPPORT_480I_576I) == 0 &&
1440                             mode->xres == 720 &&
1441                             (mode->vmode & FB_VMODE_INTERLACED))
1442                                 continue;
1443                         hdmi_add_videomode(mode, head);
1444                 }
1445         } else {
1446                 /* There are some video mode is not defined in EDID extend
1447                  * block, so we need to check first block data.
1448                  */
1449                 if (specs && specs->modedb_len) {
1450                         for (i = 0; i < specs->modedb_len; i++) {
1451                                 modedb = &specs->modedb[i];
1452                                 pixclock = hdmi_videomode_to_vic(modedb);
1453                                 if (pixclock)
1454                                         hdmi_add_vic(pixclock, head);
1455                         }
1456                 }
1457                 hdmi_sort_modelist(&hdmi->edid, hdmi->property->feature);
1458         }
1459
1460         return HDMI_ERROR_SUCCESS;
1461 }
1462
1463 /**
1464  * hdmi_videomode_to_vic: transverse video mode to vic
1465  * @vmode: videomode to transverse
1466  *
1467  */
1468 int hdmi_videomode_to_vic(struct fb_videomode *vmode)
1469 {
1470         struct fb_videomode *mode;
1471         unsigned int vic = 0;
1472         int i = 0;
1473
1474         for (i = 0; i < ARRAY_SIZE(hdmi_mode); i++) {
1475                 mode = (struct fb_videomode *)&hdmi_mode[i].mode;
1476                 if (vmode->vmode == mode->vmode &&
1477                     vmode->refresh == mode->refresh &&
1478                     vmode->xres == mode->xres &&
1479                     vmode->yres == mode->yres &&
1480                     vmode->left_margin == mode->left_margin &&
1481                     vmode->right_margin == mode->right_margin &&
1482                     vmode->upper_margin == mode->upper_margin &&
1483                     vmode->lower_margin == mode->lower_margin &&
1484                     vmode->hsync_len == mode->hsync_len &&
1485                     vmode->vsync_len == mode->vsync_len) {
1486                         vic = hdmi_mode[i].vic;
1487                         break;
1488                 }
1489         }
1490         return vic;
1491 }
1492
1493 /**
1494  * hdmi_vic2timing: transverse vic mode to video timing
1495  * @vmode: vic to transverse
1496  *
1497  */
1498 const struct hdmi_video_timing *hdmi_vic2timing(int vic)
1499 {
1500         int i;
1501
1502         if (vic == 0)
1503                 return NULL;
1504
1505         for (i = 0; i < ARRAY_SIZE(hdmi_mode); i++) {
1506                 if (hdmi_mode[i].vic == vic || hdmi_mode[i].vic_2nd == vic)
1507                         return &hdmi_mode[i];
1508         }
1509         return NULL;
1510 }
1511
1512 /**
1513  * hdmi_vic_to_videomode: transverse vic mode to video mode
1514  * @vmode: vic to transverse
1515  *
1516  */
1517 const struct fb_videomode *hdmi_vic_to_videomode(int vic)
1518 {
1519         int i, vid;
1520
1521         if (vic == 0)
1522                 return NULL;
1523         else if ((vic & HDMI_VIDEO_DMT) || (vic & HDMI_VIDEO_DISCRETE_VR))
1524                 vid = vic;
1525         else
1526                 vid = vic & HDMI_VIC_MASK;
1527         for (i = 0; i < ARRAY_SIZE(hdmi_mode); i++) {
1528                 if (hdmi_mode[i].vic == vid ||
1529                     hdmi_mode[i].vic_2nd == vid)
1530                         return &hdmi_mode[i].mode;
1531         }
1532         return NULL;
1533 }
1534
1535 /**
1536  * hdmi_init_modelist: initial hdmi mode list
1537  * @hdmi:
1538  *
1539  * NOTES:
1540  *
1541  */
1542 void hdmi_init_modelist(struct hdmi *hdmi)
1543 {
1544         int i, feature;
1545         struct list_head *head = &hdmi->edid.modelist;
1546
1547         feature = hdmi->property->feature;
1548         INIT_LIST_HEAD(&hdmi->edid.modelist);
1549         for (i = 0; i < ARRAY_SIZE(hdmi_mode); i++) {
1550                 if ((hdmi_mode[i].vic & HDMI_VIDEO_DMT) || (hdmi_mode[i].vic & HDMI_VIDEO_DISCRETE_VR))
1551                         continue;
1552                 if ((feature & SUPPORT_TMDS_600M) == 0 &&
1553                     hdmi_mode[i].mode.pixclock > 340000000)
1554                         continue;
1555                 if ((feature & SUPPORT_4K) == 0 &&
1556                     hdmi_mode[i].mode.xres >= 3840)
1557                         continue;
1558                 if ((feature & SUPPORT_4K_4096) == 0 &&
1559                     hdmi_mode[i].mode.xres == 4096)
1560                         continue;
1561                 if ((feature & SUPPORT_1080I) == 0 &&
1562                     hdmi_mode[i].mode.xres == 1920 &&
1563                     (hdmi_mode[i].mode.vmode & FB_VMODE_INTERLACED))
1564                         continue;
1565                 if ((feature & SUPPORT_480I_576I) == 0 &&
1566                     hdmi_mode[i].mode.xres == 720 &&
1567                     (hdmi_mode[i].mode.vmode & FB_VMODE_INTERLACED))
1568                         continue;
1569                 hdmi_add_videomode(&hdmi_mode[i].mode, head);
1570         }
1571 }