drivers/gpu/drm/meson/meson_venc.c

   1 /*
   2  * Copyright (C) 2016 BayLibre, SAS
   3  * Author: Neil Armstrong <[email protected]>
   4  * Copyright (C) 2015 Amlogic, Inc. All rights reserved.
   5  *
   6  * This program is free software; you can redistribute it and/or
   7  * modify it under the terms of the GNU General Public License as
   8  * published by the Free Software Foundation; either version 2 of the
   9  * License, or (at your option) any later version.
  10  *
  11  * This program is distributed in the hope that it will be useful, but
  12  * WITHOUT ANY WARRANTY; without even the implied warranty of
  13  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  14  * General Public License for more details.
  15  *
  16  * You should have received a copy of the GNU General Public License
  17  * along with this program; if not, see <http://www.gnu.org/licenses/>.
  18  */
  19
  20 #include <linux/kernel.h>
  21 #include <linux/module.h>
  22 #include <drm/drmP.h>
  23 #include "meson_drv.h"
  24 #include "meson_venc.h"
  25 #include "meson_vpp.h"
  26 #include "meson_vclk.h"
  27 #include "meson_registers.h"
  28
  29 /**
  30  * DOC: Video Encoder
  31  *
  32  * VENC Handle the pixels encoding to the output formats.
  33  * We handle the following encodings :
  34  *
  35  * - CVBS Encoding via the ENCI encoder and VDAC digital to analog converter
  36  * - TMDS/HDMI Encoding via ENCI_DIV and ENCP
  37  * - Setup of more clock rates for HDMI modes
  38  *
  39  * What is missing :
  40  *
  41  * - LCD Panel encoding via ENCL
  42  * - TV Panel encoding via ENCT
  43  *
  44  * VENC paths :
  45  *
  46  * .. code::
  47  *
  48  *          _____   _____   ____________________
  49  *   vd1---|     |-|     | | VENC     /---------|----VDAC
  50  *   vd2---| VIU |-| VPP |-|-----ENCI/-ENCI_DVI-|-|
  51  *   osd1--|     |-|     | | \                  | X--HDMI-TX
  52  *   osd2--|_____|-|_____| |  |\-ENCP--ENCP_DVI-|-|
  53  *                         |  |                 |
  54  *                         |  \--ENCL-----------|----LVDS
  55  *                         |____________________|
  56  *
  57  * The ENCI is designed for PAl or NTSC encoding and can go through the VDAC
  58  * directly for CVBS encoding or through the ENCI_DVI encoder for HDMI.
  59  * The ENCP is designed for Progressive encoding but can also generate
  60  * 1080i interlaced pixels, and was initialy desined to encode pixels for
  61  * VDAC to output RGB ou YUV analog outputs.
  62  * It's output is only used through the ENCP_DVI encoder for HDMI.
  63  * The ENCL LVDS encoder is not implemented.
  64  *
  65  * The ENCI and ENCP encoders needs specially defined parameters for each
  66  * supported mode and thus cannot be determined from standard video timings.
  67  *
  68  * The ENCI end ENCP DVI encoders are more generic and can generate any timings
  69  * from the pixel data generated by ENCI or ENCP, so can use the standard video
  70  * timings are source for HW parameters.
  71  */
  72
  73 /* HHI Registers */
  74 #define HHI_VDAC_CNTL0          0x2F4 /* 0xbd offset in data sheet */
  75 #define HHI_VDAC_CNTL1          0x2F8 /* 0xbe offset in data sheet */
  76 #define HHI_HDMI_PHY_CNTL0      0x3a0 /* 0xe8 offset in data sheet */
  77
  78 struct meson_cvbs_enci_mode meson_cvbs_enci_pal = {
  79         .mode_tag = MESON_VENC_MODE_CVBS_PAL,
  80         .hso_begin = 3,
  81         .hso_end = 129,
  82         .vso_even = 3,
  83         .vso_odd = 260,
  84         .macv_max_amp = 7,
  85         .video_prog_mode = 0xff,
  86         .video_mode = 0x13,
  87         .sch_adjust = 0x28,
  88         .yc_delay = 0x343,
  89         .pixel_start = 251,
  90         .pixel_end = 1691,
  91         .top_field_line_start = 22,
  92         .top_field_line_end = 310,
  93         .bottom_field_line_start = 23,
  94         .bottom_field_line_end = 311,
  95         .video_saturation = 9,
  96         .video_contrast = 0,
  97         .video_brightness = 0,
  98         .video_hue = 0,
  99         .analog_sync_adj = 0x8080,
 100 };
 101
 102 struct meson_cvbs_enci_mode meson_cvbs_enci_ntsc = {
 103         .mode_tag = MESON_VENC_MODE_CVBS_NTSC,
 104         .hso_begin = 5,
 105         .hso_end = 129,
 106         .vso_even = 3,
 107         .vso_odd = 260,
 108         .macv_max_amp = 0xb,
 109         .video_prog_mode = 0xf0,
 110         .video_mode = 0x8,
 111         .sch_adjust = 0x20,
 112         .yc_delay = 0x333,
 113         .pixel_start = 227,
 114         .pixel_end = 1667,
 115         .top_field_line_start = 18,
 116         .top_field_line_end = 258,
 117         .bottom_field_line_start = 19,
 118         .bottom_field_line_end = 259,
 119         .video_saturation = 18,
 120         .video_contrast = 3,
 121         .video_brightness = 0,
 122         .video_hue = 0,
 123         .analog_sync_adj = 0x9c00,
 124 };
 125
 126 union meson_hdmi_venc_mode {
 127         struct {
 128                 unsigned int mode_tag;
 129                 unsigned int hso_begin;
 130                 unsigned int hso_end;
 131                 unsigned int vso_even;
 132                 unsigned int vso_odd;
 133                 unsigned int macv_max_amp;
 134                 unsigned int video_prog_mode;
 135                 unsigned int video_mode;
 136                 unsigned int sch_adjust;
 137                 unsigned int yc_delay;
 138                 unsigned int pixel_start;
 139                 unsigned int pixel_end;
 140                 unsigned int top_field_line_start;
 141                 unsigned int top_field_line_end;
 142                 unsigned int bottom_field_line_start;
 143                 unsigned int bottom_field_line_end;
 144         } enci;
 145         struct {
 146                 unsigned int dvi_settings;
 147                 unsigned int video_mode;
 148                 unsigned int video_mode_adv;
 149                 unsigned int video_prog_mode;
 150                 bool video_prog_mode_present;
 151                 unsigned int video_sync_mode;
 152                 bool video_sync_mode_present;
 153                 unsigned int video_yc_dly;
 154                 bool video_yc_dly_present;
 155                 unsigned int video_rgb_ctrl;
 156                 bool video_rgb_ctrl_present;
 157                 unsigned int video_filt_ctrl;
 158                 bool video_filt_ctrl_present;
 159                 unsigned int video_ofld_voav_ofst;
 160                 bool video_ofld_voav_ofst_present;
 161                 unsigned int yfp1_htime;
 162                 unsigned int yfp2_htime;
 163                 unsigned int max_pxcnt;
 164                 unsigned int hspuls_begin;
 165                 unsigned int hspuls_end;
 166                 unsigned int hspuls_switch;
 167                 unsigned int vspuls_begin;
 168                 unsigned int vspuls_end;
 169                 unsigned int vspuls_bline;
 170                 unsigned int vspuls_eline;
 171                 unsigned int eqpuls_begin;
 172                 bool eqpuls_begin_present;
 173                 unsigned int eqpuls_end;
 174                 bool eqpuls_end_present;
 175                 unsigned int eqpuls_bline;
 176                 bool eqpuls_bline_present;
 177                 unsigned int eqpuls_eline;
 178                 bool eqpuls_eline_present;
 179                 unsigned int havon_begin;
 180                 unsigned int havon_end;
 181                 unsigned int vavon_bline;
 182                 unsigned int vavon_eline;
 183                 unsigned int hso_begin;
 184                 unsigned int hso_end;
 185                 unsigned int vso_begin;
 186                 unsigned int vso_end;
 187                 unsigned int vso_bline;
 188                 unsigned int vso_eline;
 189                 bool vso_eline_present;
 190                 unsigned int sy_val;
 191                 bool sy_val_present;
 192                 unsigned int sy2_val;
 193                 bool sy2_val_present;
 194                 unsigned int max_lncnt;
 195         } encp;
 196 };
 197
 198 union meson_hdmi_venc_mode meson_hdmi_enci_mode_480i = {
 199         .enci = {
 200                 .hso_begin = 5,
 201                 .hso_end = 129,
 202                 .vso_even = 3,
 203                 .vso_odd = 260,
 204                 .macv_max_amp = 0x810b,
 205                 .video_prog_mode = 0xf0,
 206                 .video_mode = 0x8,
 207                 .sch_adjust = 0x20,
 208                 .yc_delay = 0,
 209                 .pixel_start = 227,
 210                 .pixel_end = 1667,
 211                 .top_field_line_start = 18,
 212                 .top_field_line_end = 258,
 213                 .bottom_field_line_start = 19,
 214                 .bottom_field_line_end = 259,
 215         },
 216 };
 217
 218 union meson_hdmi_venc_mode meson_hdmi_enci_mode_576i = {
 219         .enci = {
 220                 .hso_begin = 3,
 221                 .hso_end = 129,
 222                 .vso_even = 3,
 223                 .vso_odd = 260,
 224                 .macv_max_amp = 8107,
 225                 .video_prog_mode = 0xff,
 226                 .video_mode = 0x13,
 227                 .sch_adjust = 0x28,
 228                 .yc_delay = 0x333,
 229                 .pixel_start = 251,
 230                 .pixel_end = 1691,
 231                 .top_field_line_start = 22,
 232                 .top_field_line_end = 310,
 233                 .bottom_field_line_start = 23,
 234                 .bottom_field_line_end = 311,
 235         },
 236 };
 237
 238 union meson_hdmi_venc_mode meson_hdmi_encp_mode_480p = {
 239         .encp = {
 240                 .dvi_settings = 0x21,
 241                 .video_mode = 0x4000,
 242                 .video_mode_adv = 0x9,
 243                 .video_prog_mode = 0,
 244                 .video_prog_mode_present = true,
 245                 .video_sync_mode = 7,
 246                 .video_sync_mode_present = true,
 247                 /* video_yc_dly */
 248                 /* video_rgb_ctrl */
 249                 .video_filt_ctrl = 0x2052,
 250                 .video_filt_ctrl_present = true,
 251                 /* video_ofld_voav_ofst */
 252                 .yfp1_htime = 244,
 253                 .yfp2_htime = 1630,
 254                 .max_pxcnt = 1715,
 255                 .hspuls_begin = 0x22,
 256                 .hspuls_end = 0xa0,
 257                 .hspuls_switch = 88,
 258                 .vspuls_begin = 0,
 259                 .vspuls_end = 1589,
 260                 .vspuls_bline = 0,
 261                 .vspuls_eline = 5,
 262                 .havon_begin = 249,
 263                 .havon_end = 1689,
 264                 .vavon_bline = 42,
 265                 .vavon_eline = 521,
 266                 /* eqpuls_begin */
 267                 /* eqpuls_end */
 268                 /* eqpuls_bline */
 269                 /* eqpuls_eline */
 270                 .hso_begin = 3,
 271                 .hso_end = 5,
 272                 .vso_begin = 3,
 273                 .vso_end = 5,
 274                 .vso_bline = 0,
 275                 /* vso_eline */
 276                 .sy_val = 8,
 277                 .sy_val_present = true,
 278                 .sy2_val = 0x1d8,
 279                 .sy2_val_present = true,
 280                 .max_lncnt = 524,
 281         },
 282 };
 283
 284 union meson_hdmi_venc_mode meson_hdmi_encp_mode_576p = {
 285         .encp = {
 286                 .dvi_settings = 0x21,
 287                 .video_mode = 0x4000,
 288                 .video_mode_adv = 0x9,
 289                 .video_prog_mode = 0,
 290                 .video_prog_mode_present = true,
 291                 .video_sync_mode = 7,
 292                 .video_sync_mode_present = true,
 293                 /* video_yc_dly */
 294                 /* video_rgb_ctrl */
 295                 .video_filt_ctrl = 0x52,
 296                 .video_filt_ctrl_present = true,
 297                 /* video_ofld_voav_ofst */
 298                 .yfp1_htime = 235,
 299                 .yfp2_htime = 1674,
 300                 .max_pxcnt = 1727,
 301                 .hspuls_begin = 0,
 302                 .hspuls_end = 0x80,
 303                 .hspuls_switch = 88,
 304                 .vspuls_begin = 0,
 305                 .vspuls_end = 1599,
 306                 .vspuls_bline = 0,
 307                 .vspuls_eline = 4,
 308                 .havon_begin = 235,
 309                 .havon_end = 1674,
 310                 .vavon_bline = 44,
 311                 .vavon_eline = 619,
 312                 /* eqpuls_begin */
 313                 /* eqpuls_end */
 314                 /* eqpuls_bline */
 315                 /* eqpuls_eline */
 316                 .hso_begin = 0x80,
 317                 .hso_end = 0,
 318                 .vso_begin = 0,
 319                 .vso_end = 5,
 320                 .vso_bline = 0,
 321                 /* vso_eline */
 322                 .sy_val = 8,
 323                 .sy_val_present = true,
 324                 .sy2_val = 0x1d8,
 325                 .sy2_val_present = true,
 326                 .max_lncnt = 624,
 327         },
 328 };
 329
 330 union meson_hdmi_venc_mode meson_hdmi_encp_mode_720p60 = {
 331         .encp = {
 332                 .dvi_settings = 0x2029,
 333                 .video_mode = 0x4040,
 334                 .video_mode_adv = 0x19,
 335                 /* video_prog_mode */
 336                 /* video_sync_mode */
 337                 /* video_yc_dly */
 338                 /* video_rgb_ctrl */
 339                 /* video_filt_ctrl */
 340                 /* video_ofld_voav_ofst */
 341                 .yfp1_htime = 648,
 342                 .yfp2_htime = 3207,
 343                 .max_pxcnt = 3299,
 344                 .hspuls_begin = 80,
 345                 .hspuls_end = 240,
 346                 .hspuls_switch = 80,
 347                 .vspuls_begin = 688,
 348                 .vspuls_end = 3248,
 349                 .vspuls_bline = 4,
 350                 .vspuls_eline = 8,
 351                 .havon_begin = 648,
 352                 .havon_end = 3207,
 353                 .vavon_bline = 29,
 354                 .vavon_eline = 748,
 355                 /* eqpuls_begin */
 356                 /* eqpuls_end */
 357                 /* eqpuls_bline */
 358                 /* eqpuls_eline */
 359                 .hso_begin = 256,
 360                 .hso_end = 168,
 361                 .vso_begin = 168,
 362                 .vso_end = 256,
 363                 .vso_bline = 0,
 364                 .vso_eline = 5,
 365                 .vso_eline_present = true,
 366                 /* sy_val */
 367                 /* sy2_val */
 368                 .max_lncnt = 749,
 369         },
 370 };
 371
 372 union meson_hdmi_venc_mode meson_hdmi_encp_mode_720p50 = {
 373         .encp = {
 374                 .dvi_settings = 0x202d,
 375                 .video_mode = 0x4040,
 376                 .video_mode_adv = 0x19,
 377                 .video_prog_mode = 0x100,
 378                 .video_prog_mode_present = true,
 379                 .video_sync_mode = 0x407,
 380                 .video_sync_mode_present = true,
 381                 .video_yc_dly = 0,
 382                 .video_yc_dly_present = true,
 383                 /* video_rgb_ctrl */
 384                 /* video_filt_ctrl */
 385                 /* video_ofld_voav_ofst */
 386                 .yfp1_htime = 648,
 387                 .yfp2_htime = 3207,
 388                 .max_pxcnt = 3959,
 389                 .hspuls_begin = 80,
 390                 .hspuls_end = 240,
 391                 .hspuls_switch = 80,
 392                 .vspuls_begin = 688,
 393                 .vspuls_end = 3248,
 394                 .vspuls_bline = 4,
 395                 .vspuls_eline = 8,
 396                 .havon_begin = 648,
 397                 .havon_end = 3207,
 398                 .vavon_bline = 29,
 399                 .vavon_eline = 748,
 400                 /* eqpuls_begin */
 401                 /* eqpuls_end */
 402                 /* eqpuls_bline */
 403                 /* eqpuls_eline */
 404                 .hso_begin = 128,
 405                 .hso_end = 208,
 406                 .vso_begin = 128,
 407                 .vso_end = 128,
 408                 .vso_bline = 0,
 409                 .vso_eline = 5,
 410                 .vso_eline_present = true,
 411                 /* sy_val */
 412                 /* sy2_val */
 413                 .max_lncnt = 749,
 414         },
 415 };
 416
 417 union meson_hdmi_venc_mode meson_hdmi_encp_mode_1080i60 = {
 418         .encp = {
 419                 .dvi_settings = 0x2029,
 420                 .video_mode = 0x5ffc,
 421                 .video_mode_adv = 0x19,
 422                 .video_prog_mode = 0x100,
 423                 .video_prog_mode_present = true,
 424                 .video_sync_mode = 0x207,
 425                 .video_sync_mode_present = true,
 426                 /* video_yc_dly */
 427                 /* video_rgb_ctrl */
 428                 /* video_filt_ctrl */
 429                 .video_ofld_voav_ofst = 0x11,
 430                 .video_ofld_voav_ofst_present = true,
 431                 .yfp1_htime = 516,
 432                 .yfp2_htime = 4355,
 433                 .max_pxcnt = 4399,
 434                 .hspuls_begin = 88,
 435                 .hspuls_end = 264,
 436                 .hspuls_switch = 88,
 437                 .vspuls_begin = 440,
 438                 .vspuls_end = 2200,
 439                 .vspuls_bline = 0,
 440                 .vspuls_eline = 4,
 441                 .havon_begin = 516,
 442                 .havon_end = 4355,
 443                 .vavon_bline = 20,
 444                 .vavon_eline = 559,
 445                 .eqpuls_begin = 2288,
 446                 .eqpuls_begin_present = true,
 447                 .eqpuls_end = 2464,
 448                 .eqpuls_end_present = true,
 449                 .eqpuls_bline = 0,
 450                 .eqpuls_bline_present = true,
 451                 .eqpuls_eline = 4,
 452                 .eqpuls_eline_present = true,
 453                 .hso_begin = 264,
 454                 .hso_end = 176,
 455                 .vso_begin = 88,
 456                 .vso_end = 88,
 457                 .vso_bline = 0,
 458                 .vso_eline = 5,
 459                 .vso_eline_present = true,
 460                 /* sy_val */
 461                 /* sy2_val */
 462                 .max_lncnt = 1124,
 463         },
 464 };
 465
 466 union meson_hdmi_venc_mode meson_hdmi_encp_mode_1080i50 = {
 467         .encp = {
 468                 .dvi_settings = 0x202d,
 469                 .video_mode = 0x5ffc,
 470                 .video_mode_adv = 0x19,
 471                 .video_prog_mode = 0x100,
 472                 .video_prog_mode_present = true,
 473                 .video_sync_mode = 0x7,
 474                 .video_sync_mode_present = true,
 475                 /* video_yc_dly */
 476                 /* video_rgb_ctrl */
 477                 /* video_filt_ctrl */
 478                 .video_ofld_voav_ofst = 0x11,
 479                 .video_ofld_voav_ofst_present = true,
 480                 .yfp1_htime = 526,
 481                 .yfp2_htime = 4365,
 482                 .max_pxcnt = 5279,
 483                 .hspuls_begin = 88,
 484                 .hspuls_end = 264,
 485                 .hspuls_switch = 88,
 486                 .vspuls_begin = 440,
 487                 .vspuls_end = 2200,
 488                 .vspuls_bline = 0,
 489                 .vspuls_eline = 4,
 490                 .havon_begin = 526,
 491                 .havon_end = 4365,
 492                 .vavon_bline = 20,
 493                 .vavon_eline = 559,
 494                 .eqpuls_begin = 2288,
 495                 .eqpuls_begin_present = true,
 496                 .eqpuls_end = 2464,
 497                 .eqpuls_end_present = true,
 498                 .eqpuls_bline = 0,
 499                 .eqpuls_bline_present = true,
 500                 .eqpuls_eline = 4,
 501                 .eqpuls_eline_present = true,
 502                 .hso_begin = 142,
 503                 .hso_end = 230,
 504                 .vso_begin = 142,
 505                 .vso_end = 142,
 506                 .vso_bline = 0,
 507                 .vso_eline = 5,
 508                 .vso_eline_present = true,
 509                 /* sy_val */
 510                 /* sy2_val */
 511                 .max_lncnt = 1124,
 512         },
 513 };
 514
 515 union meson_hdmi_venc_mode meson_hdmi_encp_mode_1080p24 = {
 516         .encp = {
 517                 .dvi_settings = 0xd,
 518                 .video_mode = 0x4040,
 519                 .video_mode_adv = 0x18,
 520                 .video_prog_mode = 0x100,
 521                 .video_prog_mode_present = true,
 522                 .video_sync_mode = 0x7,
 523                 .video_sync_mode_present = true,
 524                 .video_yc_dly = 0,
 525                 .video_yc_dly_present = true,
 526                 .video_rgb_ctrl = 2,
 527                 .video_rgb_ctrl_present = true,
 528                 .video_filt_ctrl = 0x1052,
 529                 .video_filt_ctrl_present = true,
 530                 /* video_ofld_voav_ofst */
 531                 .yfp1_htime = 271,
 532                 .yfp2_htime = 2190,
 533                 .max_pxcnt = 2749,
 534                 .hspuls_begin = 44,
 535                 .hspuls_end = 132,
 536                 .hspuls_switch = 44,
 537                 .vspuls_begin = 220,
 538                 .vspuls_end = 2140,
 539                 .vspuls_bline = 0,
 540                 .vspuls_eline = 4,
 541                 .havon_begin = 271,
 542                 .havon_end = 2190,
 543                 .vavon_bline = 41,
 544                 .vavon_eline = 1120,
 545                 /* eqpuls_begin */
 546                 /* eqpuls_end */
 547                 .eqpuls_bline = 0,
 548                 .eqpuls_bline_present = true,
 549                 .eqpuls_eline = 4,
 550                 .eqpuls_eline_present = true,
 551                 .hso_begin = 79,
 552                 .hso_end = 123,
 553                 .vso_begin = 79,
 554                 .vso_end = 79,
 555                 .vso_bline = 0,
 556                 .vso_eline = 5,
 557                 .vso_eline_present = true,
 558                 /* sy_val */
 559                 /* sy2_val */
 560                 .max_lncnt = 1124,
 561         },
 562 };
 563
 564 union meson_hdmi_venc_mode meson_hdmi_encp_mode_1080p30 = {
 565         .encp = {
 566                 .dvi_settings = 0x1,
 567                 .video_mode = 0x4040,
 568                 .video_mode_adv = 0x18,
 569                 .video_prog_mode = 0x100,
 570                 .video_prog_mode_present = true,
 571                 /* video_sync_mode */
 572                 /* video_yc_dly */
 573                 /* video_rgb_ctrl */
 574                 .video_filt_ctrl = 0x1052,
 575                 .video_filt_ctrl_present = true,
 576                 /* video_ofld_voav_ofst */
 577                 .yfp1_htime = 140,
 578                 .yfp2_htime = 2060,
 579                 .max_pxcnt = 2199,
 580                 .hspuls_begin = 2156,
 581                 .hspuls_end = 44,
 582                 .hspuls_switch = 44,
 583                 .vspuls_begin = 140,
 584                 .vspuls_end = 2059,
 585                 .vspuls_bline = 0,
 586                 .vspuls_eline = 4,
 587                 .havon_begin = 148,
 588                 .havon_end = 2067,
 589                 .vavon_bline = 41,
 590                 .vavon_eline = 1120,
 591                 /* eqpuls_begin */
 592                 /* eqpuls_end */
 593                 /* eqpuls_bline */
 594                 /* eqpuls_eline */
 595                 .hso_begin = 44,
 596                 .hso_end = 2156,
 597                 .vso_begin = 2100,
 598                 .vso_end = 2164,
 599                 .vso_bline = 0,
 600                 .vso_eline = 5,
 601                 .vso_eline_present = true,
 602                 /* sy_val */
 603                 /* sy2_val */
 604                 .max_lncnt = 1124,
 605         },
 606 };
 607
 608 union meson_hdmi_venc_mode meson_hdmi_encp_mode_1080p50 = {
 609         .encp = {
 610                 .dvi_settings = 0xd,
 611                 .video_mode = 0x4040,
 612                 .video_mode_adv = 0x18,
 613                 .video_prog_mode = 0x100,
 614                 .video_prog_mode_present = true,
 615                 .video_sync_mode = 0x7,
 616                 .video_sync_mode_present = true,
 617                 .video_yc_dly = 0,
 618                 .video_yc_dly_present = true,
 619                 .video_rgb_ctrl = 2,
 620                 .video_rgb_ctrl_present = true,
 621                 /* video_filt_ctrl */
 622                 /* video_ofld_voav_ofst */
 623                 .yfp1_htime = 271,
 624                 .yfp2_htime = 2190,
 625                 .max_pxcnt = 2639,
 626                 .hspuls_begin = 44,
 627                 .hspuls_end = 132,
 628                 .hspuls_switch = 44,
 629                 .vspuls_begin = 220,
 630                 .vspuls_end = 2140,
 631                 .vspuls_bline = 0,
 632                 .vspuls_eline = 4,
 633                 .havon_begin = 271,
 634                 .havon_end = 2190,
 635                 .vavon_bline = 41,
 636                 .vavon_eline = 1120,
 637                 /* eqpuls_begin */
 638                 /* eqpuls_end */
 639                 .eqpuls_bline = 0,
 640                 .eqpuls_bline_present = true,
 641                 .eqpuls_eline = 4,
 642                 .eqpuls_eline_present = true,
 643                 .hso_begin = 79,
 644                 .hso_end = 123,
 645                 .vso_begin = 79,
 646                 .vso_end = 79,
 647                 .vso_bline = 0,
 648                 .vso_eline = 5,
 649                 .vso_eline_present = true,
 650                 /* sy_val */
 651                 /* sy2_val */
 652                 .max_lncnt = 1124,
 653         },
 654 };
 655
 656 union meson_hdmi_venc_mode meson_hdmi_encp_mode_1080p60 = {
 657         .encp = {
 658                 .dvi_settings = 0x1,
 659                 .video_mode = 0x4040,
 660                 .video_mode_adv = 0x18,
 661                 .video_prog_mode = 0x100,
 662                 .video_prog_mode_present = true,
 663                 /* video_sync_mode */
 664                 /* video_yc_dly */
 665                 /* video_rgb_ctrl */
 666                 .video_filt_ctrl = 0x1052,
 667                 .video_filt_ctrl_present = true,
 668                 /* video_ofld_voav_ofst */
 669                 .yfp1_htime = 140,
 670                 .yfp2_htime = 2060,
 671                 .max_pxcnt = 2199,
 672                 .hspuls_begin = 2156,
 673                 .hspuls_end = 44,
 674                 .hspuls_switch = 44,
 675                 .vspuls_begin = 140,
 676                 .vspuls_end = 2059,
 677                 .vspuls_bline = 0,
 678                 .vspuls_eline = 4,
 679                 .havon_begin = 148,
 680                 .havon_end = 2067,
 681                 .vavon_bline = 41,
 682                 .vavon_eline = 1120,
 683                 /* eqpuls_begin */
 684                 /* eqpuls_end */
 685                 /* eqpuls_bline */
 686                 /* eqpuls_eline */
 687                 .hso_begin = 44,
 688                 .hso_end = 2156,
 689                 .vso_begin = 2100,
 690                 .vso_end = 2164,
 691                 .vso_bline = 0,
 692                 .vso_eline = 5,
 693                 .vso_eline_present = true,
 694                 /* sy_val */
 695                 /* sy2_val */
 696                 .max_lncnt = 1124,
 697         },
 698 };
 699
 700 union meson_hdmi_venc_mode meson_hdmi_encp_mode_640x480_60 = {
 701         .encp = {
 702                 .dvi_settings = 0x21,
 703                 .video_mode = 0x4040,
 704                 .video_mode_adv = 0x18,
 705                 /* video_prog_mode */
 706                 /* video_sync_mode */
 707                 /* video_yc_dly */
 708                 /* video_rgb_ctrl */
 709                 /* video_filt_ctrl */
 710                 /* video_ofld_voav_ofst */
 711                 /* yfp1_htime */
 712                 /* yfp2_htime */
 713                 .max_pxcnt = 0x31f,
 714                 /* hspuls_begin */
 715                 /* hspuls_end */
 716                 /* hspuls_switch */
 717                 /* vspuls_begin */
 718                 /* vspuls_end */
 719                 /* vspuls_bline */
 720                 /* vspuls_eline */
 721                 .havon_begin = 0x90,
 722                 .havon_end = 0x30f,
 723                 .vavon_bline = 0x23,
 724                 .vavon_eline = 0x202,
 725                 /* eqpuls_begin */
 726                 /* eqpuls_end */
 727                 /* eqpuls_bline */
 728                 /* eqpuls_eline */
 729                 .hso_begin = 0,
 730                 .hso_end = 0x60,
 731                 .vso_begin = 0x1e,
 732                 .vso_end = 0x32,
 733                 .vso_bline = 0,
 734                 .vso_eline = 2,
 735                 .vso_eline_present = true,
 736                 /* sy_val */
 737                 /* sy2_val */
 738                 .max_lncnt = 0x20c,
 739         },
 740 };
 741
 742 union meson_hdmi_venc_mode meson_hdmi_encp_mode_800x600_60 = {
 743         .encp = {
 744                 .dvi_settings = 0x21,
 745                 .video_mode = 0x4040,
 746                 .video_mode_adv = 0x18,
 747                 /* video_prog_mode */
 748                 /* video_sync_mode */
 749                 /* video_yc_dly */
 750                 /* video_rgb_ctrl */
 751                 /* video_filt_ctrl */
 752                 /* video_ofld_voav_ofst */
 753                 /* yfp1_htime */
 754                 /* yfp2_htime */
 755                 .max_pxcnt = 0x41f,
 756                 /* hspuls_begin */
 757                 /* hspuls_end */
 758                 /* hspuls_switch */
 759                 /* vspuls_begin */
 760                 /* vspuls_end */
 761                 /* vspuls_bline */
 762                 /* vspuls_eline */
 763                 .havon_begin = 0xD8,
 764                 .havon_end = 0x3f7,
 765                 .vavon_bline = 0x1b,
 766                 .vavon_eline = 0x272,
 767                 /* eqpuls_begin */
 768                 /* eqpuls_end */
 769                 /* eqpuls_bline */
 770                 /* eqpuls_eline */
 771                 .hso_begin = 0,
 772                 .hso_end = 0x80,
 773                 .vso_begin = 0x1e,
 774                 .vso_end = 0x32,
 775                 .vso_bline = 0,
 776                 .vso_eline = 4,
 777                 .vso_eline_present = true,
 778                 /* sy_val */
 779                 /* sy2_val */
 780                 .max_lncnt = 0x273,
 781         },
 782 };
 783
 784 union meson_hdmi_venc_mode meson_hdmi_encp_mode_1024x768_60 = {
 785         .encp = {
 786                 .dvi_settings = 0x21,
 787                 .video_mode = 0x4040,
 788                 .video_mode_adv = 0x18,
 789                 /* video_prog_mode */
 790                 /* video_sync_mode */
 791                 /* video_yc_dly */
 792                 /* video_rgb_ctrl */
 793                 /* video_filt_ctrl */
 794                 /* video_ofld_voav_ofst */
 795                 /* yfp1_htime */
 796                 /* yfp2_htime */
 797                 .max_pxcnt = 1343,
 798                 /* hspuls_begin */
 799                 /* hspuls_end */
 800                 /* hspuls_switch */
 801                 /* vspuls_begin */
 802                 /* vspuls_end */
 803                 /* vspuls_bline */
 804                 /* vspuls_eline */
 805                 .havon_begin = 296,
 806                 .havon_end = 1319,
 807                 .vavon_bline = 35,
 808                 .vavon_eline = 802,
 809                 /* eqpuls_begin */
 810                 /* eqpuls_end */
 811                 /* eqpuls_bline */
 812                 /* eqpuls_eline */
 813                 .hso_begin = 0,
 814                 .hso_end = 136,
 815                 .vso_begin = 30,
 816                 .vso_end = 50,
 817                 .vso_bline = 0,
 818                 .vso_eline = 6,
 819                 .vso_eline_present = true,
 820                 /* sy_val */
 821                 /* sy2_val */
 822                 .max_lncnt = 805,
 823         },
 824 };
 825
 826 union meson_hdmi_venc_mode meson_hdmi_encp_mode_1152x864_75 = {
 827         .encp = {
 828                 .dvi_settings = 0x21,
 829                 .video_mode = 0x4040,
 830                 .video_mode_adv = 0x18,
 831                 /* video_prog_mode */
 832                 /* video_sync_mode */
 833                 /* video_yc_dly */
 834                 /* video_rgb_ctrl */
 835                 /* video_filt_ctrl */
 836                 /* video_ofld_voav_ofst */
 837                 /* yfp1_htime */
 838                 /* yfp2_htime */
 839                 .max_pxcnt = 0x63f,
 840                 /* hspuls_begin */
 841                 /* hspuls_end */
 842                 /* hspuls_switch */
 843                 /* vspuls_begin */
 844                 /* vspuls_end */
 845                 /* vspuls_bline */
 846                 /* vspuls_eline */
 847                 .havon_begin = 0x180,
 848                 .havon_end = 0x5ff,
 849                 .vavon_bline = 0x23,
 850                 .vavon_eline = 0x382,
 851                 /* eqpuls_begin */
 852                 /* eqpuls_end */
 853                 /* eqpuls_bline */
 854                 /* eqpuls_eline */
 855                 .hso_begin = 0,
 856                 .hso_end = 0x80,
 857                 .vso_begin = 0x1e,
 858                 .vso_end = 0x32,
 859                 .vso_bline = 0,
 860                 .vso_eline = 3,
 861                 .vso_eline_present = true,
 862                 /* sy_val */
 863                 /* sy2_val */
 864                 .max_lncnt = 0x383,
 865         },
 866 };
 867
 868 union meson_hdmi_venc_mode meson_hdmi_encp_mode_1280x1024_60 = {
 869         .encp = {
 870                 .dvi_settings = 0x21,
 871                 .video_mode = 0x4040,
 872                 .video_mode_adv = 0x18,
 873                 /* video_prog_mode */
 874                 /* video_sync_mode */
 875                 /* video_yc_dly */
 876                 /* video_rgb_ctrl */
 877                 /* video_filt_ctrl */
 878                 /* video_ofld_voav_ofst */
 879                 /* yfp1_htime */
 880                 /* yfp2_htime */
 881                 .max_pxcnt = 0x697,
 882                 /* hspuls_begin */
 883                 /* hspuls_end */
 884                 /* hspuls_switch */
 885                 /* vspuls_begin */
 886                 /* vspuls_end */
 887                 /* vspuls_bline */
 888                 /* vspuls_eline */
 889                 .havon_begin = 0x168,
 890                 .havon_end = 0x667,
 891                 .vavon_bline = 0x29,
 892                 .vavon_eline = 0x428,
 893                 /* eqpuls_begin */
 894                 /* eqpuls_end */
 895                 /* eqpuls_bline */
 896                 /* eqpuls_eline */
 897                 .hso_begin = 0,
 898                 .hso_end = 0x70,
 899                 .vso_begin = 0x1e,
 900                 .vso_end = 0x32,
 901                 .vso_bline = 0,
 902                 .vso_eline = 3,
 903                 .vso_eline_present = true,
 904                 /* sy_val */
 905                 /* sy2_val */
 906                 .max_lncnt = 0x429,
 907         },
 908 };
 909
 910 union meson_hdmi_venc_mode meson_hdmi_encp_mode_1600x1200_60 = {
 911         .encp = {
 912                 .dvi_settings = 0x21,
 913                 .video_mode = 0x4040,
 914                 .video_mode_adv = 0x18,
 915                 /* video_prog_mode */
 916                 /* video_sync_mode */
 917                 /* video_yc_dly */
 918                 /* video_rgb_ctrl */
 919                 /* video_filt_ctrl */
 920                 /* video_ofld_voav_ofst */
 921                 /* yfp1_htime */
 922                 /* yfp2_htime */
 923                 .max_pxcnt = 0x86f,
 924                 /* hspuls_begin */
 925                 /* hspuls_end */
 926                 /* hspuls_switch */
 927                 /* vspuls_begin */
 928                 /* vspuls_end */
 929                 /* vspuls_bline */
 930                 /* vspuls_eline */
 931                 .havon_begin = 0x1f0,
 932                 .havon_end = 0x82f,
 933                 .vavon_bline = 0x31,
 934                 .vavon_eline = 0x4e0,
 935                 /* eqpuls_begin */
 936                 /* eqpuls_end */
 937                 /* eqpuls_bline */
 938                 /* eqpuls_eline */
 939                 .hso_begin = 0,
 940                 .hso_end = 0xc0,
 941                 .vso_begin = 0x1e,
 942                 .vso_end = 0x32,
 943                 .vso_bline = 0,
 944                 .vso_eline = 3,
 945                 .vso_eline_present = true,
 946                 /* sy_val */
 947                 /* sy2_val */
 948                 .max_lncnt = 0x4e1,
 949         },
 950 };
 951
 952 struct meson_hdmi_venc_dmt_mode {
 953         struct drm_display_mode drm_mode;
 954         union meson_hdmi_venc_mode *mode;
 955 } meson_hdmi_venc_dmt_modes[] = {
 956         /* 640x480@60Hz */
 957         {
 958                 { DRM_MODE("640x480", DRM_MODE_TYPE_DRIVER, 25175, 640, 656,
 959                   752, 800, 0, 480, 490, 492, 525, 0,
 960                   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC) },
 961                 &meson_hdmi_encp_mode_640x480_60,
 962         },
 963         /* 800x600@60Hz */
 964         {
 965                 { DRM_MODE("800x600", DRM_MODE_TYPE_DRIVER, 40000, 800, 840,
 966                   968, 1056, 0, 600, 601, 605, 628, 0,
 967                   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
 968                 &meson_hdmi_encp_mode_800x600_60,
 969         },
 970         /* 1024x768@60Hz */
 971         {
 972                 { DRM_MODE("1024x768", DRM_MODE_TYPE_DRIVER, 65000, 1024,
 973                   1048, 1184, 1344, 0, 768, 771, 777, 806, 0,
 974                   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC) },
 975                 &meson_hdmi_encp_mode_1024x768_60,
 976         },
 977         /* 1152x864@75Hz */
 978         {
 979                 { DRM_MODE("1152x864", DRM_MODE_TYPE_DRIVER, 108000, 1152,
 980                   1216, 1344, 1600, 0, 864, 865, 868, 900, 0,
 981                   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
 982                 &meson_hdmi_encp_mode_1152x864_75,
 983         },
 984         /* 1280x1024@60Hz */
 985         {
 986                 { DRM_MODE("1280x1024", DRM_MODE_TYPE_DRIVER, 108000, 1280,
 987                   1328, 1440, 1688, 0, 1024, 1025, 1028, 1066, 0,
 988                   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
 989                 &meson_hdmi_encp_mode_1280x1024_60,
 990         },
 991         /* 1600x1200@60Hz */
 992         {
 993                 { DRM_MODE("1600x1200", DRM_MODE_TYPE_DRIVER, 162000, 1600,
 994                   1664, 1856, 2160, 0, 1200, 1201, 1204, 1250, 0,
 995                   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
 996                 &meson_hdmi_encp_mode_1600x1200_60,
 997         },
 998         /* 1920x1080@60Hz */
 999         {
1000                 { DRM_MODE("1920x1080", DRM_MODE_TYPE_DRIVER, 148500, 1920,
1001                   2008, 2052, 2200, 0, 1080, 1084, 1089, 1125, 0,
1002                   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC) },
1003                 &meson_hdmi_encp_mode_1080p60
1004         },
1005         { }, /* sentinel */
1006 };
1007
1008 struct meson_hdmi_venc_vic_mode {
1009         unsigned int vic;
1010         union meson_hdmi_venc_mode *mode;
1011 } meson_hdmi_venc_vic_modes[] = {
1012         { 6, &meson_hdmi_enci_mode_480i },
1013         { 7, &meson_hdmi_enci_mode_480i },
1014         { 21, &meson_hdmi_enci_mode_576i },
1015         { 22, &meson_hdmi_enci_mode_576i },
1016         { 2, &meson_hdmi_encp_mode_480p },
1017         { 3, &meson_hdmi_encp_mode_480p },
1018         { 17, &meson_hdmi_encp_mode_576p },
1019         { 18, &meson_hdmi_encp_mode_576p },
1020         { 4, &meson_hdmi_encp_mode_720p60 },
1021         { 19, &meson_hdmi_encp_mode_720p50 },
1022         { 5, &meson_hdmi_encp_mode_1080i60 },
1023         { 20, &meson_hdmi_encp_mode_1080i50 },
1024         { 32, &meson_hdmi_encp_mode_1080p24 },
1025         { 34, &meson_hdmi_encp_mode_1080p30 },
1026         { 31, &meson_hdmi_encp_mode_1080p50 },
1027         { 16, &meson_hdmi_encp_mode_1080p60 },
1028         { 0, NULL}, /* sentinel */
1029 };
1030
1031 static signed int to_signed(unsigned int a)
1032 {
1033         if (a <= 7)
1034                 return a;
1035         else
1036                 return a - 16;
1037 }
1038
1039 static unsigned long modulo(unsigned long a, unsigned long b)
1040 {
1041         if (a >= b)
1042                 return a - b;
1043         else
1044                 return a;
1045 }
1046
1047 bool meson_venc_hdmi_supported_mode(const struct drm_display_mode *mode)
1048 {
1049         struct meson_hdmi_venc_dmt_mode *vmode = meson_hdmi_venc_dmt_modes;
1050
1051         while (vmode->mode) {
1052                 if (drm_mode_equal(&vmode->drm_mode, mode))
1053                         return true;
1054                 vmode++;
1055         }
1056
1057         return false;
1058 }
1059 EXPORT_SYMBOL_GPL(meson_venc_hdmi_supported_mode);
1060
1061 bool meson_venc_hdmi_supported_vic(int vic)
1062 {
1063         struct meson_hdmi_venc_vic_mode *vmode = meson_hdmi_venc_vic_modes;
1064
1065         while (vmode->vic && vmode->mode) {
1066                 if (vmode->vic == vic)
1067                         return true;
1068                 vmode++;
1069         }
1070
1071         return false;
1072 }
1073 EXPORT_SYMBOL_GPL(meson_venc_hdmi_supported_vic);
1074
1075 static union meson_hdmi_venc_mode
1076 *meson_venc_hdmi_get_dmt_vmode(const struct drm_display_mode *mode)
1077 {
1078         struct meson_hdmi_venc_dmt_mode *vmode = meson_hdmi_venc_dmt_modes;
1079
1080         while (vmode->mode) {
1081                 if (drm_mode_equal(&vmode->drm_mode, mode))
1082                         return vmode->mode;
1083                 vmode++;
1084         }
1085
1086         return NULL;
1087 }
1088
1089 static union meson_hdmi_venc_mode *meson_venc_hdmi_get_vic_vmode(int vic)
1090 {
1091         struct meson_hdmi_venc_vic_mode *vmode = meson_hdmi_venc_vic_modes;
1092
1093         while (vmode->vic && vmode->mode) {
1094                 if (vmode->vic == vic)
1095                         return vmode->mode;
1096                 vmode++;
1097         }
1098
1099         return NULL;
1100 }
1101
1102 bool meson_venc_hdmi_venc_repeat(int vic)
1103 {
1104         /* Repeat VENC pixels for 480/576i/p, 720p50/60 and 1080p50/60 */
1105         if (vic == 6 || vic == 7 || /* 480i */
1106             vic == 21 || vic == 22 || /* 576i */
1107             vic == 17 || vic == 18 || /* 576p */
1108             vic == 2 || vic == 3 || /* 480p */
1109             vic == 4 || /* 720p60 */
1110             vic == 19 || /* 720p50 */
1111             vic == 5 || /* 1080i60 */
1112             vic == 20)  /* 1080i50 */
1113                 return true;
1114
1115         return false;
1116 }
1117 EXPORT_SYMBOL_GPL(meson_venc_hdmi_venc_repeat);
1118
1119 void meson_venc_hdmi_mode_set(struct meson_drm *priv, int vic,
1120                               struct drm_display_mode *mode)
1121 {
1122         union meson_hdmi_venc_mode *vmode = NULL;
1123         bool use_enci = false;
1124         bool venc_repeat = false;
1125         bool hdmi_repeat = false;
1126         unsigned int venc_hdmi_latency = 2;
1127         unsigned long total_pixels_venc = 0;
1128         unsigned long active_pixels_venc = 0;
1129         unsigned long front_porch_venc = 0;
1130         unsigned long hsync_pixels_venc = 0;
1131         unsigned long de_h_begin = 0;
1132         unsigned long de_h_end = 0;
1133         unsigned long de_v_begin_even = 0;
1134         unsigned long de_v_end_even = 0;
1135         unsigned long de_v_begin_odd = 0;
1136         unsigned long de_v_end_odd = 0;
1137         unsigned long hs_begin = 0;
1138         unsigned long hs_end = 0;
1139         unsigned long vs_adjust = 0;
1140         unsigned long vs_bline_evn = 0;
1141         unsigned long vs_eline_evn = 0;
1142         unsigned long vs_bline_odd = 0;
1143         unsigned long vs_eline_odd = 0;
1144         unsigned long vso_begin_evn = 0;
1145         unsigned long vso_begin_odd = 0;
1146         unsigned int eof_lines;
1147         unsigned int sof_lines;
1148         unsigned int vsync_lines;
1149
1150         if (meson_venc_hdmi_supported_vic(vic))
1151                 vmode = meson_venc_hdmi_get_vic_vmode(vic);
1152         else
1153                 vmode = meson_venc_hdmi_get_dmt_vmode(mode);
1154         if (!vmode) {
1155                 dev_err(priv->dev, "%s: Fatal Error, unsupported mode "
1156                         DRM_MODE_FMT "\n", __func__, DRM_MODE_ARG(mode));
1157                 return;
1158         }
1159
1160         /* Use VENCI for 480i and 576i and double HDMI pixels */
1161         if (mode->flags & DRM_MODE_FLAG_DBLCLK) {
1162                 hdmi_repeat = true;
1163                 use_enci = true;
1164                 venc_hdmi_latency = 1;
1165         }
1166
1167         /* Repeat VENC pixels for 480/576i/p, 720p50/60 and 1080p50/60 */
1168         if (meson_venc_hdmi_venc_repeat(vic))
1169                 venc_repeat = true;
1170
1171         eof_lines = mode->vsync_start - mode->vdisplay;
1172         if (mode->flags & DRM_MODE_FLAG_INTERLACE)
1173                 eof_lines /= 2;
1174         sof_lines = mode->vtotal - mode->vsync_end;
1175         if (mode->flags & DRM_MODE_FLAG_INTERLACE)
1176                 sof_lines /= 2;
1177         vsync_lines = mode->vsync_end - mode->vsync_start;
1178         if (mode->flags & DRM_MODE_FLAG_INTERLACE)
1179                 vsync_lines /= 2;
1180
1181         total_pixels_venc = mode->htotal;
1182         if (hdmi_repeat)
1183                 total_pixels_venc /= 2;
1184         if (venc_repeat)
1185                 total_pixels_venc *= 2;
1186
1187         active_pixels_venc = mode->hdisplay;
1188         if (hdmi_repeat)
1189                 active_pixels_venc /= 2;
1190         if (venc_repeat)
1191                 active_pixels_venc *= 2;
1192
1193         front_porch_venc = (mode->hsync_start - mode->hdisplay);
1194         if (hdmi_repeat)
1195                 front_porch_venc /= 2;
1196         if (venc_repeat)
1197                 front_porch_venc *= 2;
1198
1199         hsync_pixels_venc = (mode->hsync_end - mode->hsync_start);
1200         if (hdmi_repeat)
1201                 hsync_pixels_venc /= 2;
1202         if (venc_repeat)
1203                 hsync_pixels_venc *= 2;
1204
1205         /* Disable VDACs */
1206         writel_bits_relaxed(0xff, 0xff,
1207                         priv->io_base + _REG(VENC_VDAC_SETTING));
1208
1209         writel_relaxed(0, priv->io_base + _REG(ENCI_VIDEO_EN));
1210         writel_relaxed(0, priv->io_base + _REG(ENCP_VIDEO_EN));
1211
1212         if (use_enci) {
1213                 unsigned int lines_f0;
1214                 unsigned int lines_f1;
1215
1216                 /* CVBS Filter settings */
1217                 writel_relaxed(0x12, priv->io_base + _REG(ENCI_CFILT_CTRL));
1218                 writel_relaxed(0x12, priv->io_base + _REG(ENCI_CFILT_CTRL2));
1219
1220                 /* Digital Video Select : Interlace, clk27 clk, external */
1221                 writel_relaxed(0, priv->io_base + _REG(VENC_DVI_SETTING));
1222
1223                 /* Reset Video Mode */
1224                 writel_relaxed(0, priv->io_base + _REG(ENCI_VIDEO_MODE));
1225                 writel_relaxed(0, priv->io_base + _REG(ENCI_VIDEO_MODE_ADV));
1226
1227                 /* Horizontal sync signal output */
1228                 writel_relaxed(vmode->enci.hso_begin,
1229                                 priv->io_base + _REG(ENCI_SYNC_HSO_BEGIN));
1230                 writel_relaxed(vmode->enci.hso_end,
1231                                 priv->io_base + _REG(ENCI_SYNC_HSO_END));
1232
1233                 /* Vertical Sync lines */
1234                 writel_relaxed(vmode->enci.vso_even,
1235                                 priv->io_base + _REG(ENCI_SYNC_VSO_EVNLN));
1236                 writel_relaxed(vmode->enci.vso_odd,
1237                                 priv->io_base + _REG(ENCI_SYNC_VSO_ODDLN));
1238
1239                 /* Macrovision max amplitude change */
1240                 writel_relaxed(vmode->enci.macv_max_amp,
1241                                 priv->io_base + _REG(ENCI_MACV_MAX_AMP));
1242
1243                 /* Video mode */
1244                 writel_relaxed(vmode->enci.video_prog_mode,
1245                                 priv->io_base + _REG(VENC_VIDEO_PROG_MODE));
1246                 writel_relaxed(vmode->enci.video_mode,
1247                                 priv->io_base + _REG(ENCI_VIDEO_MODE));
1248
1249                 /* Advanced Video Mode :
1250                  * Demux shifting 0x2
1251                  * Blank line end at line17/22
1252                  * High bandwidth Luma Filter
1253                  * Low bandwidth Chroma Filter
1254                  * Bypass luma low pass filter
1255                  * No macrovision on CSYNC
1256                  */
1257                 writel_relaxed(0x26, priv->io_base + _REG(ENCI_VIDEO_MODE_ADV));
1258
1259                 writel(vmode->enci.sch_adjust,
1260                                 priv->io_base + _REG(ENCI_VIDEO_SCH));
1261
1262                 /* Sync mode : MASTER Master mode, free run, send HSO/VSO out */
1263                 writel_relaxed(0x07, priv->io_base + _REG(ENCI_SYNC_MODE));
1264
1265                 if (vmode->enci.yc_delay)
1266                         writel_relaxed(vmode->enci.yc_delay,
1267                                         priv->io_base + _REG(ENCI_YC_DELAY));
1268
1269
1270                 /* UNreset Interlaced TV Encoder */
1271                 writel_relaxed(0, priv->io_base + _REG(ENCI_DBG_PX_RST));
1272
1273                 /* Enable Vfifo2vd, Y_Cb_Y_Cr select */
1274                 writel_relaxed(0x4e01, priv->io_base + _REG(ENCI_VFIFO2VD_CTL));
1275
1276                 /* Timings */
1277                 writel_relaxed(vmode->enci.pixel_start,
1278                         priv->io_base + _REG(ENCI_VFIFO2VD_PIXEL_START));
1279                 writel_relaxed(vmode->enci.pixel_end,
1280                         priv->io_base + _REG(ENCI_VFIFO2VD_PIXEL_END));
1281
1282                 writel_relaxed(vmode->enci.top_field_line_start,
1283                         priv->io_base + _REG(ENCI_VFIFO2VD_LINE_TOP_START));
1284                 writel_relaxed(vmode->enci.top_field_line_end,
1285                         priv->io_base + _REG(ENCI_VFIFO2VD_LINE_TOP_END));
1286
1287                 writel_relaxed(vmode->enci.bottom_field_line_start,
1288                         priv->io_base + _REG(ENCI_VFIFO2VD_LINE_BOT_START));
1289                 writel_relaxed(vmode->enci.bottom_field_line_end,
1290                         priv->io_base + _REG(ENCI_VFIFO2VD_LINE_BOT_END));
1291
1292                 /* Select ENCI for VIU */
1293                 meson_vpp_setup_mux(priv, MESON_VIU_VPP_MUX_ENCI);
1294
1295                 /* Interlace video enable */
1296                 writel_relaxed(1, priv->io_base + _REG(ENCI_VIDEO_EN));
1297
1298                 lines_f0 = mode->vtotal >> 1;
1299                 lines_f1 = lines_f0 + 1;
1300
1301                 de_h_begin = modulo(readl_relaxed(priv->io_base +
1302                                         _REG(ENCI_VFIFO2VD_PIXEL_START))
1303                                         + venc_hdmi_latency,
1304                                     total_pixels_venc);
1305                 de_h_end  = modulo(de_h_begin + active_pixels_venc,
1306                                    total_pixels_venc);
1307
1308                 writel_relaxed(de_h_begin,
1309                                 priv->io_base + _REG(ENCI_DE_H_BEGIN));
1310                 writel_relaxed(de_h_end,
1311                                 priv->io_base + _REG(ENCI_DE_H_END));
1312
1313                 de_v_begin_even = readl_relaxed(priv->io_base +
1314                                         _REG(ENCI_VFIFO2VD_LINE_TOP_START));
1315                 de_v_end_even  = de_v_begin_even + mode->vdisplay;
1316                 de_v_begin_odd = readl_relaxed(priv->io_base +
1317                                         _REG(ENCI_VFIFO2VD_LINE_BOT_START));
1318                 de_v_end_odd = de_v_begin_odd + mode->vdisplay;
1319
1320                 writel_relaxed(de_v_begin_even,
1321                                 priv->io_base + _REG(ENCI_DE_V_BEGIN_EVEN));
1322                 writel_relaxed(de_v_end_even,
1323                                 priv->io_base + _REG(ENCI_DE_V_END_EVEN));
1324                 writel_relaxed(de_v_begin_odd,
1325                                 priv->io_base + _REG(ENCI_DE_V_BEGIN_ODD));
1326                 writel_relaxed(de_v_end_odd,
1327                                 priv->io_base + _REG(ENCI_DE_V_END_ODD));
1328
1329                 /* Program Hsync timing */
1330                 hs_begin = de_h_end + front_porch_venc;
1331                 if (de_h_end + front_porch_venc >= total_pixels_venc) {
1332                         hs_begin -= total_pixels_venc;
1333                         vs_adjust  = 1;
1334                 } else {
1335                         hs_begin = de_h_end + front_porch_venc;
1336                         vs_adjust  = 0;
1337                 }
1338
1339                 hs_end = modulo(hs_begin + hsync_pixels_venc,
1340                                 total_pixels_venc);
1341                 writel_relaxed(hs_begin,
1342                                 priv->io_base + _REG(ENCI_DVI_HSO_BEGIN));
1343                 writel_relaxed(hs_end,
1344                                 priv->io_base + _REG(ENCI_DVI_HSO_END));
1345
1346                 /* Program Vsync timing for even field */
1347                 if (((de_v_end_odd - 1) + eof_lines + vs_adjust) >= lines_f1) {
1348                         vs_bline_evn = (de_v_end_odd - 1)
1349                                         + eof_lines
1350                                         + vs_adjust
1351                                         - lines_f1;
1352                         vs_eline_evn = vs_bline_evn + vsync_lines;
1353
1354                         writel_relaxed(vs_bline_evn,
1355                                 priv->io_base + _REG(ENCI_DVI_VSO_BLINE_EVN));
1356
1357                         writel_relaxed(vs_eline_evn,
1358                                 priv->io_base + _REG(ENCI_DVI_VSO_ELINE_EVN));
1359
1360                         writel_relaxed(hs_begin,
1361                                 priv->io_base + _REG(ENCI_DVI_VSO_BEGIN_EVN));
1362                         writel_relaxed(hs_begin,
1363                                 priv->io_base + _REG(ENCI_DVI_VSO_END_EVN));
1364                 } else {
1365                         vs_bline_odd = (de_v_end_odd - 1)
1366                                         + eof_lines
1367                                         + vs_adjust;
1368
1369                         writel_relaxed(vs_bline_odd,
1370                                 priv->io_base + _REG(ENCI_DVI_VSO_BLINE_ODD));
1371
1372                         writel_relaxed(hs_begin,
1373                                 priv->io_base + _REG(ENCI_DVI_VSO_BEGIN_ODD));
1374
1375                         if ((vs_bline_odd + vsync_lines) >= lines_f1) {
1376                                 vs_eline_evn = vs_bline_odd
1377                                                 + vsync_lines
1378                                                 - lines_f1;
1379
1380                                 writel_relaxed(vs_eline_evn, priv->io_base
1381                                                 + _REG(ENCI_DVI_VSO_ELINE_EVN));
1382
1383                                 writel_relaxed(hs_begin, priv->io_base
1384                                                 + _REG(ENCI_DVI_VSO_END_EVN));
1385                         } else {
1386                                 vs_eline_odd = vs_bline_odd
1387                                                 + vsync_lines;
1388
1389                                 writel_relaxed(vs_eline_odd, priv->io_base
1390                                                 + _REG(ENCI_DVI_VSO_ELINE_ODD));
1391
1392                                 writel_relaxed(hs_begin, priv->io_base
1393                                                 + _REG(ENCI_DVI_VSO_END_ODD));
1394                         }
1395                 }
1396
1397                 /* Program Vsync timing for odd field */
1398                 if (((de_v_end_even - 1) + (eof_lines + 1)) >= lines_f0) {
1399                         vs_bline_odd = (de_v_end_even - 1)
1400                                         + (eof_lines + 1)
1401                                         - lines_f0;
1402                         vs_eline_odd = vs_bline_odd + vsync_lines;
1403
1404                         writel_relaxed(vs_bline_odd,
1405                                 priv->io_base + _REG(ENCI_DVI_VSO_BLINE_ODD));
1406
1407                         writel_relaxed(vs_eline_odd,
1408                                 priv->io_base + _REG(ENCI_DVI_VSO_ELINE_ODD));
1409
1410                         vso_begin_odd  = modulo(hs_begin
1411                                                 + (total_pixels_venc >> 1),
1412                                                 total_pixels_venc);
1413
1414                         writel_relaxed(vso_begin_odd,
1415                                 priv->io_base + _REG(ENCI_DVI_VSO_BEGIN_ODD));
1416                         writel_relaxed(vso_begin_odd,
1417                                 priv->io_base + _REG(ENCI_DVI_VSO_END_ODD));
1418                 } else {
1419                         vs_bline_evn = (de_v_end_even - 1)
1420                                         + (eof_lines + 1);
1421
1422                         writel_relaxed(vs_bline_evn,
1423                                 priv->io_base + _REG(ENCI_DVI_VSO_BLINE_EVN));
1424
1425                         vso_begin_evn  = modulo(hs_begin
1426                                                 + (total_pixels_venc >> 1),
1427                                                 total_pixels_venc);
1428
1429                         writel_relaxed(vso_begin_evn, priv->io_base
1430                                         + _REG(ENCI_DVI_VSO_BEGIN_EVN));
1431
1432                         if (vs_bline_evn + vsync_lines >= lines_f0) {
1433                                 vs_eline_odd = vs_bline_evn
1434                                                 + vsync_lines
1435                                                 - lines_f0;
1436
1437                                 writel_relaxed(vs_eline_odd, priv->io_base
1438                                                 + _REG(ENCI_DVI_VSO_ELINE_ODD));
1439
1440                                 writel_relaxed(vso_begin_evn, priv->io_base
1441                                                 + _REG(ENCI_DVI_VSO_END_ODD));
1442                         } else {
1443                                 vs_eline_evn = vs_bline_evn + vsync_lines;
1444
1445                                 writel_relaxed(vs_eline_evn, priv->io_base
1446                                                 + _REG(ENCI_DVI_VSO_ELINE_EVN));
1447
1448                                 writel_relaxed(vso_begin_evn, priv->io_base
1449                                                 + _REG(ENCI_DVI_VSO_END_EVN));
1450                         }
1451                 }
1452         } else {
1453                 writel_relaxed(vmode->encp.dvi_settings,
1454                                 priv->io_base + _REG(VENC_DVI_SETTING));
1455                 writel_relaxed(vmode->encp.video_mode,
1456                                 priv->io_base + _REG(ENCP_VIDEO_MODE));
1457                 writel_relaxed(vmode->encp.video_mode_adv,
1458                                 priv->io_base + _REG(ENCP_VIDEO_MODE_ADV));
1459                 if (vmode->encp.video_prog_mode_present)
1460                         writel_relaxed(vmode->encp.video_prog_mode,
1461                                 priv->io_base + _REG(VENC_VIDEO_PROG_MODE));
1462                 if (vmode->encp.video_sync_mode_present)
1463                         writel_relaxed(vmode->encp.video_sync_mode,
1464                                 priv->io_base + _REG(ENCP_VIDEO_SYNC_MODE));
1465                 if (vmode->encp.video_yc_dly_present)
1466                         writel_relaxed(vmode->encp.video_yc_dly,
1467                                 priv->io_base + _REG(ENCP_VIDEO_YC_DLY));
1468                 if (vmode->encp.video_rgb_ctrl_present)
1469                         writel_relaxed(vmode->encp.video_rgb_ctrl,
1470                                 priv->io_base + _REG(ENCP_VIDEO_RGB_CTRL));
1471                 if (vmode->encp.video_filt_ctrl_present)
1472                         writel_relaxed(vmode->encp.video_filt_ctrl,
1473                                 priv->io_base + _REG(ENCP_VIDEO_FILT_CTRL));
1474                 if (vmode->encp.video_ofld_voav_ofst_present)
1475                         writel_relaxed(vmode->encp.video_ofld_voav_ofst,
1476                                 priv->io_base
1477                                 + _REG(ENCP_VIDEO_OFLD_VOAV_OFST));
1478                 writel_relaxed(vmode->encp.yfp1_htime,
1479                                 priv->io_base + _REG(ENCP_VIDEO_YFP1_HTIME));
1480                 writel_relaxed(vmode->encp.yfp2_htime,
1481                                 priv->io_base + _REG(ENCP_VIDEO_YFP2_HTIME));
1482                 writel_relaxed(vmode->encp.max_pxcnt,
1483                                 priv->io_base + _REG(ENCP_VIDEO_MAX_PXCNT));
1484                 writel_relaxed(vmode->encp.hspuls_begin,
1485                                 priv->io_base + _REG(ENCP_VIDEO_HSPULS_BEGIN));
1486                 writel_relaxed(vmode->encp.hspuls_end,
1487                                 priv->io_base + _REG(ENCP_VIDEO_HSPULS_END));
1488                 writel_relaxed(vmode->encp.hspuls_switch,
1489                                 priv->io_base + _REG(ENCP_VIDEO_HSPULS_SWITCH));
1490                 writel_relaxed(vmode->encp.vspuls_begin,
1491                                 priv->io_base + _REG(ENCP_VIDEO_VSPULS_BEGIN));
1492                 writel_relaxed(vmode->encp.vspuls_end,
1493                                 priv->io_base + _REG(ENCP_VIDEO_VSPULS_END));
1494                 writel_relaxed(vmode->encp.vspuls_bline,
1495                                 priv->io_base + _REG(ENCP_VIDEO_VSPULS_BLINE));
1496                 writel_relaxed(vmode->encp.vspuls_eline,
1497                                 priv->io_base + _REG(ENCP_VIDEO_VSPULS_ELINE));
1498                 if (vmode->encp.eqpuls_begin_present)
1499                         writel_relaxed(vmode->encp.eqpuls_begin,
1500                                 priv->io_base + _REG(ENCP_VIDEO_EQPULS_BEGIN));
1501                 if (vmode->encp.eqpuls_end_present)
1502                         writel_relaxed(vmode->encp.eqpuls_end,
1503                                 priv->io_base + _REG(ENCP_VIDEO_EQPULS_END));
1504                 if (vmode->encp.eqpuls_bline_present)
1505                         writel_relaxed(vmode->encp.eqpuls_bline,
1506                                 priv->io_base + _REG(ENCP_VIDEO_EQPULS_BLINE));
1507                 if (vmode->encp.eqpuls_eline_present)
1508                         writel_relaxed(vmode->encp.eqpuls_eline,
1509                                 priv->io_base + _REG(ENCP_VIDEO_EQPULS_ELINE));
1510                 writel_relaxed(vmode->encp.havon_begin,
1511                                 priv->io_base + _REG(ENCP_VIDEO_HAVON_BEGIN));
1512                 writel_relaxed(vmode->encp.havon_end,
1513                                 priv->io_base + _REG(ENCP_VIDEO_HAVON_END));
1514                 writel_relaxed(vmode->encp.vavon_bline,
1515                                 priv->io_base + _REG(ENCP_VIDEO_VAVON_BLINE));
1516                 writel_relaxed(vmode->encp.vavon_eline,
1517                                 priv->io_base + _REG(ENCP_VIDEO_VAVON_ELINE));
1518                 writel_relaxed(vmode->encp.hso_begin,
1519                                 priv->io_base + _REG(ENCP_VIDEO_HSO_BEGIN));
1520                 writel_relaxed(vmode->encp.hso_end,
1521                                 priv->io_base + _REG(ENCP_VIDEO_HSO_END));
1522                 writel_relaxed(vmode->encp.vso_begin,
1523                                 priv->io_base + _REG(ENCP_VIDEO_VSO_BEGIN));
1524                 writel_relaxed(vmode->encp.vso_end,
1525                                 priv->io_base + _REG(ENCP_VIDEO_VSO_END));
1526                 writel_relaxed(vmode->encp.vso_bline,
1527                                 priv->io_base + _REG(ENCP_VIDEO_VSO_BLINE));
1528                 if (vmode->encp.vso_eline_present)
1529                         writel_relaxed(vmode->encp.vso_eline,
1530                                 priv->io_base + _REG(ENCP_VIDEO_VSO_ELINE));
1531                 if (vmode->encp.sy_val_present)
1532                         writel_relaxed(vmode->encp.sy_val,
1533                                 priv->io_base + _REG(ENCP_VIDEO_SY_VAL));
1534                 if (vmode->encp.sy2_val_present)
1535                         writel_relaxed(vmode->encp.sy2_val,
1536                                 priv->io_base + _REG(ENCP_VIDEO_SY2_VAL));
1537                 writel_relaxed(vmode->encp.max_lncnt,
1538                                 priv->io_base + _REG(ENCP_VIDEO_MAX_LNCNT));
1539
1540                 writel_relaxed(1, priv->io_base + _REG(ENCP_VIDEO_EN));
1541
1542                 /* Set DE signal’s polarity is active high */
1543                 writel_bits_relaxed(BIT(14), BIT(14),
1544                                     priv->io_base + _REG(ENCP_VIDEO_MODE));
1545
1546                 /* Program DE timing */
1547                 de_h_begin = modulo(readl_relaxed(priv->io_base +
1548                                         _REG(ENCP_VIDEO_HAVON_BEGIN))
1549                                         + venc_hdmi_latency,
1550                                     total_pixels_venc);
1551                 de_h_end = modulo(de_h_begin + active_pixels_venc,
1552                                   total_pixels_venc);
1553
1554                 writel_relaxed(de_h_begin,
1555                                 priv->io_base + _REG(ENCP_DE_H_BEGIN));
1556                 writel_relaxed(de_h_end,
1557                                 priv->io_base + _REG(ENCP_DE_H_END));
1558
1559                 /* Program DE timing for even field */
1560                 de_v_begin_even = readl_relaxed(priv->io_base
1561                                                 + _REG(ENCP_VIDEO_VAVON_BLINE));
1562                 if (mode->flags & DRM_MODE_FLAG_INTERLACE)
1563                         de_v_end_even = de_v_begin_even +
1564                                         (mode->vdisplay / 2);
1565                 else
1566                         de_v_end_even = de_v_begin_even + mode->vdisplay;
1567
1568                 writel_relaxed(de_v_begin_even,
1569                                 priv->io_base + _REG(ENCP_DE_V_BEGIN_EVEN));
1570                 writel_relaxed(de_v_end_even,
1571                                 priv->io_base + _REG(ENCP_DE_V_END_EVEN));
1572
1573                 /* Program DE timing for odd field if needed */
1574                 if (mode->flags & DRM_MODE_FLAG_INTERLACE) {
1575                         unsigned int ofld_voav_ofst =
1576                                 readl_relaxed(priv->io_base +
1577                                         _REG(ENCP_VIDEO_OFLD_VOAV_OFST));
1578                         de_v_begin_odd = to_signed((ofld_voav_ofst & 0xf0) >> 4)
1579                                                 + de_v_begin_even
1580                                                 + ((mode->vtotal - 1) / 2);
1581                         de_v_end_odd = de_v_begin_odd + (mode->vdisplay / 2);
1582
1583                         writel_relaxed(de_v_begin_odd,
1584                                 priv->io_base + _REG(ENCP_DE_V_BEGIN_ODD));
1585                         writel_relaxed(de_v_end_odd,
1586                                 priv->io_base + _REG(ENCP_DE_V_END_ODD));
1587                 }
1588
1589                 /* Program Hsync timing */
1590                 if ((de_h_end + front_porch_venc) >= total_pixels_venc) {
1591                         hs_begin = de_h_end
1592                                    + front_porch_venc
1593                                    - total_pixels_venc;
1594                         vs_adjust  = 1;
1595                 } else {
1596                         hs_begin = de_h_end
1597                                    + front_porch_venc;
1598                         vs_adjust  = 0;
1599                 }
1600
1601                 hs_end = modulo(hs_begin + hsync_pixels_venc,
1602                                 total_pixels_venc);
1603
1604                 writel_relaxed(hs_begin,
1605                                 priv->io_base + _REG(ENCP_DVI_HSO_BEGIN));
1606                 writel_relaxed(hs_end,
1607                                 priv->io_base + _REG(ENCP_DVI_HSO_END));
1608
1609                 /* Program Vsync timing for even field */
1610                 if (de_v_begin_even >=
1611                                 (sof_lines + vsync_lines + (1 - vs_adjust)))
1612                         vs_bline_evn = de_v_begin_even
1613                                         - sof_lines
1614                                         - vsync_lines
1615                                         - (1 - vs_adjust);
1616                 else
1617                         vs_bline_evn = mode->vtotal
1618                                         + de_v_begin_even
1619                                         - sof_lines
1620                                         - vsync_lines
1621                                         - (1 - vs_adjust);
1622
1623                 vs_eline_evn = modulo(vs_bline_evn + vsync_lines,
1624                                         mode->vtotal);
1625
1626                 writel_relaxed(vs_bline_evn,
1627                                 priv->io_base + _REG(ENCP_DVI_VSO_BLINE_EVN));
1628                 writel_relaxed(vs_eline_evn,
1629                                 priv->io_base + _REG(ENCP_DVI_VSO_ELINE_EVN));
1630
1631                 vso_begin_evn = hs_begin;
1632                 writel_relaxed(vso_begin_evn,
1633                                 priv->io_base + _REG(ENCP_DVI_VSO_BEGIN_EVN));
1634                 writel_relaxed(vso_begin_evn,
1635                                 priv->io_base + _REG(ENCP_DVI_VSO_END_EVN));
1636
1637                 /* Program Vsync timing for odd field if needed */
1638                 if (mode->flags & DRM_MODE_FLAG_INTERLACE) {
1639                         vs_bline_odd = (de_v_begin_odd - 1)
1640                                         - sof_lines
1641                                         - vsync_lines;
1642                         vs_eline_odd = (de_v_begin_odd - 1)
1643                                         - vsync_lines;
1644                         vso_begin_odd  = modulo(hs_begin
1645                                                 + (total_pixels_venc >> 1),
1646                                                 total_pixels_venc);
1647
1648                         writel_relaxed(vs_bline_odd,
1649                                 priv->io_base + _REG(ENCP_DVI_VSO_BLINE_ODD));
1650                         writel_relaxed(vs_eline_odd,
1651                                 priv->io_base + _REG(ENCP_DVI_VSO_ELINE_ODD));
1652                         writel_relaxed(vso_begin_odd,
1653                                 priv->io_base + _REG(ENCP_DVI_VSO_BEGIN_ODD));
1654                         writel_relaxed(vso_begin_odd,
1655                                 priv->io_base + _REG(ENCP_DVI_VSO_END_ODD));
1656                 }
1657
1658                 /* Select ENCP for VIU */
1659                 meson_vpp_setup_mux(priv, MESON_VIU_VPP_MUX_ENCP);
1660         }
1661
1662         writel_relaxed((use_enci ? 1 : 2) |
1663                        (mode->flags & DRM_MODE_FLAG_PHSYNC ? 1 << 2 : 0) |
1664                        (mode->flags & DRM_MODE_FLAG_PVSYNC ? 1 << 3 : 0) |
1665                        4 << 5 |
1666                        (venc_repeat ? 1 << 8 : 0) |
1667                        (hdmi_repeat ? 1 << 12 : 0),
1668                        priv->io_base + _REG(VPU_HDMI_SETTING));
1669
1670         priv->venc.hdmi_repeat = hdmi_repeat;
1671         priv->venc.venc_repeat = venc_repeat;
1672         priv->venc.hdmi_use_enci = use_enci;
1673
1674         priv->venc.current_mode = MESON_VENC_MODE_HDMI;
1675 }
1676 EXPORT_SYMBOL_GPL(meson_venc_hdmi_mode_set);
1677
1678 void meson_venci_cvbs_mode_set(struct meson_drm *priv,
1679                                struct meson_cvbs_enci_mode *mode)
1680 {
1681         if (mode->mode_tag == priv->venc.current_mode)
1682                 return;
1683
1684         /* CVBS Filter settings */
1685         writel_relaxed(0x12, priv->io_base + _REG(ENCI_CFILT_CTRL));
1686         writel_relaxed(0x12, priv->io_base + _REG(ENCI_CFILT_CTRL2));
1687
1688         /* Digital Video Select : Interlace, clk27 clk, external */
1689         writel_relaxed(0, priv->io_base + _REG(VENC_DVI_SETTING));
1690
1691         /* Reset Video Mode */
1692         writel_relaxed(0, priv->io_base + _REG(ENCI_VIDEO_MODE));
1693         writel_relaxed(0, priv->io_base + _REG(ENCI_VIDEO_MODE_ADV));
1694
1695         /* Horizontal sync signal output */
1696         writel_relaxed(mode->hso_begin,
1697                         priv->io_base + _REG(ENCI_SYNC_HSO_BEGIN));
1698         writel_relaxed(mode->hso_end,
1699                         priv->io_base + _REG(ENCI_SYNC_HSO_END));
1700
1701         /* Vertical Sync lines */
1702         writel_relaxed(mode->vso_even,
1703                         priv->io_base + _REG(ENCI_SYNC_VSO_EVNLN));
1704         writel_relaxed(mode->vso_odd,
1705                         priv->io_base + _REG(ENCI_SYNC_VSO_ODDLN));
1706
1707         /* Macrovision max amplitude change */
1708         writel_relaxed(0x8100 + mode->macv_max_amp,
1709                         priv->io_base + _REG(ENCI_MACV_MAX_AMP));
1710
1711         /* Video mode */
1712         writel_relaxed(mode->video_prog_mode,
1713                         priv->io_base + _REG(VENC_VIDEO_PROG_MODE));
1714         writel_relaxed(mode->video_mode,
1715                         priv->io_base + _REG(ENCI_VIDEO_MODE));
1716
1717         /* Advanced Video Mode :
1718          * Demux shifting 0x2
1719          * Blank line end at line17/22
1720          * High bandwidth Luma Filter
1721          * Low bandwidth Chroma Filter
1722          * Bypass luma low pass filter
1723          * No macrovision on CSYNC
1724          */
1725         writel_relaxed(0x26, priv->io_base + _REG(ENCI_VIDEO_MODE_ADV));
1726
1727         writel(mode->sch_adjust, priv->io_base + _REG(ENCI_VIDEO_SCH));
1728
1729         /* Sync mode : MASTER Master mode, free run, send HSO/VSO out */
1730         writel_relaxed(0x07, priv->io_base + _REG(ENCI_SYNC_MODE));
1731
1732         /* 0x3 Y, C, and Component Y delay */
1733         writel_relaxed(mode->yc_delay, priv->io_base + _REG(ENCI_YC_DELAY));
1734
1735         /* Timings */
1736         writel_relaxed(mode->pixel_start,
1737                         priv->io_base + _REG(ENCI_VFIFO2VD_PIXEL_START));
1738         writel_relaxed(mode->pixel_end,
1739                         priv->io_base + _REG(ENCI_VFIFO2VD_PIXEL_END));
1740
1741         writel_relaxed(mode->top_field_line_start,
1742                         priv->io_base + _REG(ENCI_VFIFO2VD_LINE_TOP_START));
1743         writel_relaxed(mode->top_field_line_end,
1744                         priv->io_base + _REG(ENCI_VFIFO2VD_LINE_TOP_END));
1745
1746         writel_relaxed(mode->bottom_field_line_start,
1747                         priv->io_base + _REG(ENCI_VFIFO2VD_LINE_BOT_START));
1748         writel_relaxed(mode->bottom_field_line_end,
1749                         priv->io_base + _REG(ENCI_VFIFO2VD_LINE_BOT_END));
1750
1751         /* Internal Venc, Internal VIU Sync, Internal Vencoder */
1752         writel_relaxed(0, priv->io_base + _REG(VENC_SYNC_ROUTE));
1753
1754         /* UNreset Interlaced TV Encoder */
1755         writel_relaxed(0, priv->io_base + _REG(ENCI_DBG_PX_RST));
1756
1757         /* Enable Vfifo2vd, Y_Cb_Y_Cr select */
1758         writel_relaxed(0x4e01, priv->io_base + _REG(ENCI_VFIFO2VD_CTL));
1759
1760         /* Power UP Dacs */
1761         writel_relaxed(0, priv->io_base + _REG(VENC_VDAC_SETTING));
1762
1763         /* Video Upsampling */
1764         writel_relaxed(0x0061, priv->io_base + _REG(VENC_UPSAMPLE_CTRL0));
1765         writel_relaxed(0x4061, priv->io_base + _REG(VENC_UPSAMPLE_CTRL1));
1766         writel_relaxed(0x5061, priv->io_base + _REG(VENC_UPSAMPLE_CTRL2));
1767
1768         /* Select Interlace Y DACs */
1769         writel_relaxed(0, priv->io_base + _REG(VENC_VDAC_DACSEL0));
1770         writel_relaxed(0, priv->io_base + _REG(VENC_VDAC_DACSEL1));
1771         writel_relaxed(0, priv->io_base + _REG(VENC_VDAC_DACSEL2));
1772         writel_relaxed(0, priv->io_base + _REG(VENC_VDAC_DACSEL3));
1773         writel_relaxed(0, priv->io_base + _REG(VENC_VDAC_DACSEL4));
1774         writel_relaxed(0, priv->io_base + _REG(VENC_VDAC_DACSEL5));
1775
1776         /* Select ENCI for VIU */
1777         meson_vpp_setup_mux(priv, MESON_VIU_VPP_MUX_ENCI);
1778
1779         /* Enable ENCI FIFO */
1780         writel_relaxed(0x2000, priv->io_base + _REG(VENC_VDAC_FIFO_CTRL));
1781
1782         /* Select ENCI DACs 0, 1, 4, and 5 */
1783         writel_relaxed(0x11, priv->io_base + _REG(ENCI_DACSEL_0));
1784         writel_relaxed(0x11, priv->io_base + _REG(ENCI_DACSEL_1));
1785
1786         /* Interlace video enable */
1787         writel_relaxed(1, priv->io_base + _REG(ENCI_VIDEO_EN));
1788
1789         /* Configure Video Saturation / Contrast / Brightness / Hue */
1790         writel_relaxed(mode->video_saturation,
1791                         priv->io_base + _REG(ENCI_VIDEO_SAT));
1792         writel_relaxed(mode->video_contrast,
1793                         priv->io_base + _REG(ENCI_VIDEO_CONT));
1794         writel_relaxed(mode->video_brightness,
1795                         priv->io_base + _REG(ENCI_VIDEO_BRIGHT));
1796         writel_relaxed(mode->video_hue,
1797                         priv->io_base + _REG(ENCI_VIDEO_HUE));
1798
1799         /* Enable DAC0 Filter */
1800         writel_relaxed(0x1, priv->io_base + _REG(VENC_VDAC_DAC0_FILT_CTRL0));
1801         writel_relaxed(0xfc48, priv->io_base + _REG(VENC_VDAC_DAC0_FILT_CTRL1));
1802
1803         /* 0 in Macrovision register 0 */
1804         writel_relaxed(0, priv->io_base + _REG(ENCI_MACV_N0));
1805
1806         /* Analog Synchronization and color burst value adjust */
1807         writel_relaxed(mode->analog_sync_adj,
1808                         priv->io_base + _REG(ENCI_SYNC_ADJ));
1809
1810         priv->venc.current_mode = mode->mode_tag;
1811 }
1812
1813 /* Returns the current ENCI field polarity */
1814 unsigned int meson_venci_get_field(struct meson_drm *priv)
1815 {
1816         return readl_relaxed(priv->io_base + _REG(ENCI_INFO_READ)) & BIT(29);
1817 }
1818
1819 void meson_venc_enable_vsync(struct meson_drm *priv)
1820 {
1821         writel_relaxed(2, priv->io_base + _REG(VENC_INTCTRL));
1822 }
1823
1824 void meson_venc_disable_vsync(struct meson_drm *priv)
1825 {
1826         writel_relaxed(0, priv->io_base + _REG(VENC_INTCTRL));
1827 }
1828
1829 void meson_venc_init(struct meson_drm *priv)
1830 {
1831         /* Disable CVBS VDAC */
1832         regmap_write(priv->hhi, HHI_VDAC_CNTL0, 0);
1833         regmap_write(priv->hhi, HHI_VDAC_CNTL1, 8);
1834
1835         /* Power Down Dacs */
1836         writel_relaxed(0xff, priv->io_base + _REG(VENC_VDAC_SETTING));
1837
1838         /* Disable HDMI PHY */
1839         regmap_write(priv->hhi, HHI_HDMI_PHY_CNTL0, 0);
1840
1841         /* Disable HDMI */
1842         writel_bits_relaxed(0x3, 0,
1843                             priv->io_base + _REG(VPU_HDMI_SETTING));
1844
1845         /* Disable all encoders */
1846         writel_relaxed(0, priv->io_base + _REG(ENCI_VIDEO_EN));
1847         writel_relaxed(0, priv->io_base + _REG(ENCP_VIDEO_EN));
1848         writel_relaxed(0, priv->io_base + _REG(ENCL_VIDEO_EN));
1849
1850         /* Disable VSync IRQ */
1851         meson_venc_disable_vsync(priv);
1852
1853         priv->venc.current_mode = MESON_VENC_MODE_NONE;
1854 }