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