| // SPDX-License-Identifier: GPL-2.0-or-later | |
| /* | |
| * Copyright (C) 2016 BayLibre, SAS | |
| * Author: Neil Armstrong <narmstrong@baylibre.com> | |
| * Copyright (C) 2015 Amlogic, Inc. All rights reserved. | |
| */ | |
| #include <linux/bitfield.h> | |
| #include <linux/export.h> | |
| #include <linux/iopoll.h> | |
| #include <drm/drm_modes.h> | |
| #include "meson_drv.h" | |
| #include "meson_registers.h" | |
| #include "meson_venc.h" | |
| #include "meson_vpp.h" | |
| /** | |
| * DOC: Video Encoder | |
| * | |
| * VENC Handle the pixels encoding to the output formats. | |
| * We handle the following encodings : | |
| * | |
| * - CVBS Encoding via the ENCI encoder and VDAC digital to analog converter | |
| * - TMDS/HDMI Encoding via ENCI_DIV and ENCP | |
| * - Setup of more clock rates for HDMI modes | |
| * | |
| * What is missing : | |
| * | |
| * - LCD Panel encoding via ENCL | |
| * - TV Panel encoding via ENCT | |
| * | |
| * VENC paths : | |
| * | |
| * .. code:: | |
| * | |
| * _____ _____ ____________________ | |
| * vd1---| |-| | | VENC /---------|----VDAC | |
| * vd2---| VIU |-| VPP |-|-----ENCI/-ENCI_DVI-|-| | |
| * osd1--| |-| | | \ | X--HDMI-TX | |
| * osd2--|_____|-|_____| | |\-ENCP--ENCP_DVI-|-| | |
| * | | | | |
| * | \--ENCL-----------|----LVDS | |
| * |____________________| | |
| * | |
| * The ENCI is designed for PAl or NTSC encoding and can go through the VDAC | |
| * directly for CVBS encoding or through the ENCI_DVI encoder for HDMI. | |
| * The ENCP is designed for Progressive encoding but can also generate | |
| * 1080i interlaced pixels, and was initially designed to encode pixels for | |
| * VDAC to output RGB ou YUV analog outputs. | |
| * It's output is only used through the ENCP_DVI encoder for HDMI. | |
| * The ENCL LVDS encoder is not implemented. | |
| * | |
| * The ENCI and ENCP encoders needs specially defined parameters for each | |
| * supported mode and thus cannot be determined from standard video timings. | |
| * | |
| * The ENCI end ENCP DVI encoders are more generic and can generate any timings | |
| * from the pixel data generated by ENCI or ENCP, so can use the standard video | |
| * timings are source for HW parameters. | |
| */ | |
| /* HHI Registers */ | |
| #define HHI_GCLK_MPEG2 0x148 /* 0x52 offset in data sheet */ | |
| #define HHI_VDAC_CNTL0 0x2F4 /* 0xbd offset in data sheet */ | |
| #define HHI_VDAC_CNTL0_G12A 0x2EC /* 0xbb offset in data sheet */ | |
| #define HHI_VDAC_CNTL1 0x2F8 /* 0xbe offset in data sheet */ | |
| #define HHI_VDAC_CNTL1_G12A 0x2F0 /* 0xbc offset in data sheet */ | |
| #define HHI_HDMI_PHY_CNTL0 0x3a0 /* 0xe8 offset in data sheet */ | |
| struct meson_cvbs_enci_mode meson_cvbs_enci_pal = { | |
| .mode_tag = MESON_VENC_MODE_CVBS_PAL, | |
| .hso_begin = 3, | |
| .hso_end = 129, | |
| .vso_even = 3, | |
| .vso_odd = 260, | |
| .macv_max_amp = 7, | |
| .video_prog_mode = 0xff, | |
| .video_mode = 0x13, | |
| .sch_adjust = 0x28, | |
| .yc_delay = 0x343, | |
| .pixel_start = 251, | |
| .pixel_end = 1691, | |
| .top_field_line_start = 22, | |
| .top_field_line_end = 310, | |
| .bottom_field_line_start = 23, | |
| .bottom_field_line_end = 311, | |
| .video_saturation = 9, | |
| .video_contrast = 0, | |
| .video_brightness = 0, | |
| .video_hue = 0, | |
| .analog_sync_adj = 0x8080, | |
| }; | |
| struct meson_cvbs_enci_mode meson_cvbs_enci_ntsc = { | |
| .mode_tag = MESON_VENC_MODE_CVBS_NTSC, | |
| .hso_begin = 5, | |
| .hso_end = 129, | |
| .vso_even = 3, | |
| .vso_odd = 260, | |
| .macv_max_amp = 0xb, | |
| .video_prog_mode = 0xf0, | |
| .video_mode = 0x8, | |
| .sch_adjust = 0x20, | |
| .yc_delay = 0x333, | |
| .pixel_start = 227, | |
| .pixel_end = 1667, | |
| .top_field_line_start = 18, | |
| .top_field_line_end = 258, | |
| .bottom_field_line_start = 19, | |
| .bottom_field_line_end = 259, | |
| .video_saturation = 18, | |
| .video_contrast = 3, | |
| .video_brightness = 0, | |
| .video_hue = 0, | |
| .analog_sync_adj = 0x9c00, | |
| }; | |
| union meson_hdmi_venc_mode { | |
| struct { | |
| unsigned int mode_tag; | |
| unsigned int hso_begin; | |
| unsigned int hso_end; | |
| unsigned int vso_even; | |
| unsigned int vso_odd; | |
| unsigned int macv_max_amp; | |
| unsigned int video_prog_mode; | |
| unsigned int video_mode; | |
| unsigned int sch_adjust; | |
| unsigned int yc_delay; | |
| unsigned int pixel_start; | |
| unsigned int pixel_end; | |
| unsigned int top_field_line_start; | |
| unsigned int top_field_line_end; | |
| unsigned int bottom_field_line_start; | |
| unsigned int bottom_field_line_end; | |
| } enci; | |
| struct { | |
| unsigned int dvi_settings; | |
| unsigned int video_mode; | |
| unsigned int video_mode_adv; | |
| unsigned int video_prog_mode; | |
| bool video_prog_mode_present; | |
| unsigned int video_sync_mode; | |
| bool video_sync_mode_present; | |
| unsigned int video_yc_dly; | |
| bool video_yc_dly_present; | |
| unsigned int video_rgb_ctrl; | |
| bool video_rgb_ctrl_present; | |
| unsigned int video_filt_ctrl; | |
| bool video_filt_ctrl_present; | |
| unsigned int video_ofld_voav_ofst; | |
| bool video_ofld_voav_ofst_present; | |
| unsigned int yfp1_htime; | |
| unsigned int yfp2_htime; | |
| unsigned int max_pxcnt; | |
| unsigned int hspuls_begin; | |
| unsigned int hspuls_end; | |
| unsigned int hspuls_switch; | |
| unsigned int vspuls_begin; | |
| unsigned int vspuls_end; | |
| unsigned int vspuls_bline; | |
| unsigned int vspuls_eline; | |
| unsigned int eqpuls_begin; | |
| bool eqpuls_begin_present; | |
| unsigned int eqpuls_end; | |
| bool eqpuls_end_present; | |
| unsigned int eqpuls_bline; | |
| bool eqpuls_bline_present; | |
| unsigned int eqpuls_eline; | |
| bool eqpuls_eline_present; | |
| unsigned int havon_begin; | |
| unsigned int havon_end; | |
| unsigned int vavon_bline; | |
| unsigned int vavon_eline; | |
| unsigned int hso_begin; | |
| unsigned int hso_end; | |
| unsigned int vso_begin; | |
| unsigned int vso_end; | |
| unsigned int vso_bline; | |
| unsigned int vso_eline; | |
| bool vso_eline_present; | |
| unsigned int sy_val; | |
| bool sy_val_present; | |
| unsigned int sy2_val; | |
| bool sy2_val_present; | |
| unsigned int max_lncnt; | |
| } encp; | |
| }; | |
| static union meson_hdmi_venc_mode meson_hdmi_enci_mode_480i = { | |
| .enci = { | |
| .hso_begin = 5, | |
| .hso_end = 129, | |
| .vso_even = 3, | |
| .vso_odd = 260, | |
| .macv_max_amp = 0xb, | |
| .video_prog_mode = 0xf0, | |
| .video_mode = 0x8, | |
| .sch_adjust = 0x20, | |
| .yc_delay = 0, | |
| .pixel_start = 227, | |
| .pixel_end = 1667, | |
| .top_field_line_start = 18, | |
| .top_field_line_end = 258, | |
| .bottom_field_line_start = 19, | |
| .bottom_field_line_end = 259, | |
| }, | |
| }; | |
| static union meson_hdmi_venc_mode meson_hdmi_enci_mode_576i = { | |
| .enci = { | |
| .hso_begin = 3, | |
| .hso_end = 129, | |
| .vso_even = 3, | |
| .vso_odd = 260, | |
| .macv_max_amp = 0x7, | |
| .video_prog_mode = 0xff, | |
| .video_mode = 0x13, | |
| .sch_adjust = 0x28, | |
| .yc_delay = 0x333, | |
| .pixel_start = 251, | |
| .pixel_end = 1691, | |
| .top_field_line_start = 22, | |
| .top_field_line_end = 310, | |
| .bottom_field_line_start = 23, | |
| .bottom_field_line_end = 311, | |
| }, | |
| }; | |
| static union meson_hdmi_venc_mode meson_hdmi_encp_mode_480p = { | |
| .encp = { | |
| .dvi_settings = 0x21, | |
| .video_mode = 0x4000, | |
| .video_mode_adv = 0x9, | |
| .video_prog_mode = 0, | |
| .video_prog_mode_present = true, | |
| .video_sync_mode = 7, | |
| .video_sync_mode_present = true, | |
| /* video_yc_dly */ | |
| /* video_rgb_ctrl */ | |
| .video_filt_ctrl = 0x2052, | |
| .video_filt_ctrl_present = true, | |
| /* video_ofld_voav_ofst */ | |
| .yfp1_htime = 244, | |
| .yfp2_htime = 1630, | |
| .max_pxcnt = 1715, | |
| .hspuls_begin = 0x22, | |
| .hspuls_end = 0xa0, | |
| .hspuls_switch = 88, | |
| .vspuls_begin = 0, | |
| .vspuls_end = 1589, | |
| .vspuls_bline = 0, | |
| .vspuls_eline = 5, | |
| .havon_begin = 249, | |
| .havon_end = 1689, | |
| .vavon_bline = 42, | |
| .vavon_eline = 521, | |
| /* eqpuls_begin */ | |
| /* eqpuls_end */ | |
| /* eqpuls_bline */ | |
| /* eqpuls_eline */ | |
| .hso_begin = 3, | |
| .hso_end = 5, | |
| .vso_begin = 3, | |
| .vso_end = 5, | |
| .vso_bline = 0, | |
| /* vso_eline */ | |
| .sy_val = 8, | |
| .sy_val_present = true, | |
| .sy2_val = 0x1d8, | |
| .sy2_val_present = true, | |
| .max_lncnt = 524, | |
| }, | |
| }; | |
| static union meson_hdmi_venc_mode meson_hdmi_encp_mode_576p = { | |
| .encp = { | |
| .dvi_settings = 0x21, | |
| .video_mode = 0x4000, | |
| .video_mode_adv = 0x9, | |
| .video_prog_mode = 0, | |
| .video_prog_mode_present = true, | |
| .video_sync_mode = 7, | |
| .video_sync_mode_present = true, | |
| /* video_yc_dly */ | |
| /* video_rgb_ctrl */ | |
| .video_filt_ctrl = 0x52, | |
| .video_filt_ctrl_present = true, | |
| /* video_ofld_voav_ofst */ | |
| .yfp1_htime = 235, | |
| .yfp2_htime = 1674, | |
| .max_pxcnt = 1727, | |
| .hspuls_begin = 0, | |
| .hspuls_end = 0x80, | |
| .hspuls_switch = 88, | |
| .vspuls_begin = 0, | |
| .vspuls_end = 1599, | |
| .vspuls_bline = 0, | |
| .vspuls_eline = 4, | |
| .havon_begin = 235, | |
| .havon_end = 1674, | |
| .vavon_bline = 44, | |
| .vavon_eline = 619, | |
| /* eqpuls_begin */ | |
| /* eqpuls_end */ | |
| /* eqpuls_bline */ | |
| /* eqpuls_eline */ | |
| .hso_begin = 0x80, | |
| .hso_end = 0, | |
| .vso_begin = 0, | |
| .vso_end = 5, | |
| .vso_bline = 0, | |
| /* vso_eline */ | |
| .sy_val = 8, | |
| .sy_val_present = true, | |
| .sy2_val = 0x1d8, | |
| .sy2_val_present = true, | |
| .max_lncnt = 624, | |
| }, | |
| }; | |
| static union meson_hdmi_venc_mode meson_hdmi_encp_mode_720p60 = { | |
| .encp = { | |
| .dvi_settings = 0x2029, | |
| .video_mode = 0x4040, | |
| .video_mode_adv = 0x19, | |
| /* video_prog_mode */ | |
| /* video_sync_mode */ | |
| /* video_yc_dly */ | |
| /* video_rgb_ctrl */ | |
| /* video_filt_ctrl */ | |
| /* video_ofld_voav_ofst */ | |
| .yfp1_htime = 648, | |
| .yfp2_htime = 3207, | |
| .max_pxcnt = 3299, | |
| .hspuls_begin = 80, | |
| .hspuls_end = 240, | |
| .hspuls_switch = 80, | |
| .vspuls_begin = 688, | |
| .vspuls_end = 3248, | |
| .vspuls_bline = 4, | |
| .vspuls_eline = 8, | |
| .havon_begin = 648, | |
| .havon_end = 3207, | |
| .vavon_bline = 29, | |
| .vavon_eline = 748, | |
| /* eqpuls_begin */ | |
| /* eqpuls_end */ | |
| /* eqpuls_bline */ | |
| /* eqpuls_eline */ | |
| .hso_begin = 256, | |
| .hso_end = 168, | |
| .vso_begin = 168, | |
| .vso_end = 256, | |
| .vso_bline = 0, | |
| .vso_eline = 5, | |
| .vso_eline_present = true, | |
| /* sy_val */ | |
| /* sy2_val */ | |
| .max_lncnt = 749, | |
| }, | |
| }; | |
| static union meson_hdmi_venc_mode meson_hdmi_encp_mode_720p50 = { | |
| .encp = { | |
| .dvi_settings = 0x202d, | |
| .video_mode = 0x4040, | |
| .video_mode_adv = 0x19, | |
| .video_prog_mode = 0x100, | |
| .video_prog_mode_present = true, | |
| .video_sync_mode = 0x407, | |
| .video_sync_mode_present = true, | |
| .video_yc_dly = 0, | |
| .video_yc_dly_present = true, | |
| /* video_rgb_ctrl */ | |
| /* video_filt_ctrl */ | |
| /* video_ofld_voav_ofst */ | |
| .yfp1_htime = 648, | |
| .yfp2_htime = 3207, | |
| .max_pxcnt = 3959, | |
| .hspuls_begin = 80, | |
| .hspuls_end = 240, | |
| .hspuls_switch = 80, | |
| .vspuls_begin = 688, | |
| .vspuls_end = 3248, | |
| .vspuls_bline = 4, | |
| .vspuls_eline = 8, | |
| .havon_begin = 648, | |
| .havon_end = 3207, | |
| .vavon_bline = 29, | |
| .vavon_eline = 748, | |
| /* eqpuls_begin */ | |
| /* eqpuls_end */ | |
| /* eqpuls_bline */ | |
| /* eqpuls_eline */ | |
| .hso_begin = 128, | |
| .hso_end = 208, | |
| .vso_begin = 128, | |
| .vso_end = 128, | |
| .vso_bline = 0, | |
| .vso_eline = 5, | |
| .vso_eline_present = true, | |
| /* sy_val */ | |
| /* sy2_val */ | |
| .max_lncnt = 749, | |
| }, | |
| }; | |
| static union meson_hdmi_venc_mode meson_hdmi_encp_mode_1080i60 = { | |
| .encp = { | |
| .dvi_settings = 0x2029, | |
| .video_mode = 0x5ffc, | |
| .video_mode_adv = 0x19, | |
| .video_prog_mode = 0x100, | |
| .video_prog_mode_present = true, | |
| .video_sync_mode = 0x207, | |
| .video_sync_mode_present = true, | |
| /* video_yc_dly */ | |
| /* video_rgb_ctrl */ | |
| /* video_filt_ctrl */ | |
| .video_ofld_voav_ofst = 0x11, | |
| .video_ofld_voav_ofst_present = true, | |
| .yfp1_htime = 516, | |
| .yfp2_htime = 4355, | |
| .max_pxcnt = 4399, | |
| .hspuls_begin = 88, | |
| .hspuls_end = 264, | |
| .hspuls_switch = 88, | |
| .vspuls_begin = 440, | |
| .vspuls_end = 2200, | |
| .vspuls_bline = 0, | |
| .vspuls_eline = 4, | |
| .havon_begin = 516, | |
| .havon_end = 4355, | |
| .vavon_bline = 20, | |
| .vavon_eline = 559, | |
| .eqpuls_begin = 2288, | |
| .eqpuls_begin_present = true, | |
| .eqpuls_end = 2464, | |
| .eqpuls_end_present = true, | |
| .eqpuls_bline = 0, | |
| .eqpuls_bline_present = true, | |
| .eqpuls_eline = 4, | |
| .eqpuls_eline_present = true, | |
| .hso_begin = 264, | |
| .hso_end = 176, | |
| .vso_begin = 88, | |
| .vso_end = 88, | |
| .vso_bline = 0, | |
| .vso_eline = 5, | |
| .vso_eline_present = true, | |
| /* sy_val */ | |
| /* sy2_val */ | |
| .max_lncnt = 1124, | |
| }, | |
| }; | |
| static union meson_hdmi_venc_mode meson_hdmi_encp_mode_1080i50 = { | |
| .encp = { | |
| .dvi_settings = 0x202d, | |
| .video_mode = 0x5ffc, | |
| .video_mode_adv = 0x19, | |
| .video_prog_mode = 0x100, | |
| .video_prog_mode_present = true, | |
| .video_sync_mode = 0x7, | |
| .video_sync_mode_present = true, | |
| /* video_yc_dly */ | |
| /* video_rgb_ctrl */ | |
| /* video_filt_ctrl */ | |
| .video_ofld_voav_ofst = 0x11, | |
| .video_ofld_voav_ofst_present = true, | |
| .yfp1_htime = 526, | |
| .yfp2_htime = 4365, | |
| .max_pxcnt = 5279, | |
| .hspuls_begin = 88, | |
| .hspuls_end = 264, | |
| .hspuls_switch = 88, | |
| .vspuls_begin = 440, | |
| .vspuls_end = 2200, | |
| .vspuls_bline = 0, | |
| .vspuls_eline = 4, | |
| .havon_begin = 526, | |
| .havon_end = 4365, | |
| .vavon_bline = 20, | |
| .vavon_eline = 559, | |
| .eqpuls_begin = 2288, | |
| .eqpuls_begin_present = true, | |
| .eqpuls_end = 2464, | |
| .eqpuls_end_present = true, | |
| .eqpuls_bline = 0, | |
| .eqpuls_bline_present = true, | |
| .eqpuls_eline = 4, | |
| .eqpuls_eline_present = true, | |
| .hso_begin = 142, | |
| .hso_end = 230, | |
| .vso_begin = 142, | |
| .vso_end = 142, | |
| .vso_bline = 0, | |
| .vso_eline = 5, | |
| .vso_eline_present = true, | |
| /* sy_val */ | |
| /* sy2_val */ | |
| .max_lncnt = 1124, | |
| }, | |
| }; | |
| static union meson_hdmi_venc_mode meson_hdmi_encp_mode_1080p24 = { | |
| .encp = { | |
| .dvi_settings = 0xd, | |
| .video_mode = 0x4040, | |
| .video_mode_adv = 0x18, | |
| .video_prog_mode = 0x100, | |
| .video_prog_mode_present = true, | |
| .video_sync_mode = 0x7, | |
| .video_sync_mode_present = true, | |
| .video_yc_dly = 0, | |
| .video_yc_dly_present = true, | |
| .video_rgb_ctrl = 2, | |
| .video_rgb_ctrl_present = true, | |
| .video_filt_ctrl = 0x1052, | |
| .video_filt_ctrl_present = true, | |
| /* video_ofld_voav_ofst */ | |
| .yfp1_htime = 271, | |
| .yfp2_htime = 2190, | |
| .max_pxcnt = 2749, | |
| .hspuls_begin = 44, | |
| .hspuls_end = 132, | |
| .hspuls_switch = 44, | |
| .vspuls_begin = 220, | |
| .vspuls_end = 2140, | |
| .vspuls_bline = 0, | |
| .vspuls_eline = 4, | |
| .havon_begin = 271, | |
| .havon_end = 2190, | |
| .vavon_bline = 41, | |
| .vavon_eline = 1120, | |
| /* eqpuls_begin */ | |
| /* eqpuls_end */ | |
| .eqpuls_bline = 0, | |
| .eqpuls_bline_present = true, | |
| .eqpuls_eline = 4, | |
| .eqpuls_eline_present = true, | |
| .hso_begin = 79, | |
| .hso_end = 123, | |
| .vso_begin = 79, | |
| .vso_end = 79, | |
| .vso_bline = 0, | |
| .vso_eline = 5, | |
| .vso_eline_present = true, | |
| /* sy_val */ | |
| /* sy2_val */ | |
| .max_lncnt = 1124, | |
| }, | |
| }; | |
| static union meson_hdmi_venc_mode meson_hdmi_encp_mode_1080p30 = { | |
| .encp = { | |
| .dvi_settings = 0x1, | |
| .video_mode = 0x4040, | |
| .video_mode_adv = 0x18, | |
| .video_prog_mode = 0x100, | |
| .video_prog_mode_present = true, | |
| /* video_sync_mode */ | |
| /* video_yc_dly */ | |
| /* video_rgb_ctrl */ | |
| .video_filt_ctrl = 0x1052, | |
| .video_filt_ctrl_present = true, | |
| /* video_ofld_voav_ofst */ | |
| .yfp1_htime = 140, | |
| .yfp2_htime = 2060, | |
| .max_pxcnt = 2199, | |
| .hspuls_begin = 2156, | |
| .hspuls_end = 44, | |
| .hspuls_switch = 44, | |
| .vspuls_begin = 140, | |
| .vspuls_end = 2059, | |
| .vspuls_bline = 0, | |
| .vspuls_eline = 4, | |
| .havon_begin = 148, | |
| .havon_end = 2067, | |
| .vavon_bline = 41, | |
| .vavon_eline = 1120, | |
| /* eqpuls_begin */ | |
| /* eqpuls_end */ | |
| /* eqpuls_bline */ | |
| /* eqpuls_eline */ | |
| .hso_begin = 44, | |
| .hso_end = 2156, | |
| .vso_begin = 2100, | |
| .vso_end = 2164, | |
| .vso_bline = 0, | |
| .vso_eline = 5, | |
| .vso_eline_present = true, | |
| /* sy_val */ | |
| /* sy2_val */ | |
| .max_lncnt = 1124, | |
| }, | |
| }; | |
| static union meson_hdmi_venc_mode meson_hdmi_encp_mode_1080p50 = { | |
| .encp = { | |
| .dvi_settings = 0xd, | |
| .video_mode = 0x4040, | |
| .video_mode_adv = 0x18, | |
| .video_prog_mode = 0x100, | |
| .video_prog_mode_present = true, | |
| .video_sync_mode = 0x7, | |
| .video_sync_mode_present = true, | |
| .video_yc_dly = 0, | |
| .video_yc_dly_present = true, | |
| .video_rgb_ctrl = 2, | |
| .video_rgb_ctrl_present = true, | |
| /* video_filt_ctrl */ | |
| /* video_ofld_voav_ofst */ | |
| .yfp1_htime = 271, | |
| .yfp2_htime = 2190, | |
| .max_pxcnt = 2639, | |
| .hspuls_begin = 44, | |
| .hspuls_end = 132, | |
| .hspuls_switch = 44, | |
| .vspuls_begin = 220, | |
| .vspuls_end = 2140, | |
| .vspuls_bline = 0, | |
| .vspuls_eline = 4, | |
| .havon_begin = 271, | |
| .havon_end = 2190, | |
| .vavon_bline = 41, | |
| .vavon_eline = 1120, | |
| /* eqpuls_begin */ | |
| /* eqpuls_end */ | |
| .eqpuls_bline = 0, | |
| .eqpuls_bline_present = true, | |
| .eqpuls_eline = 4, | |
| .eqpuls_eline_present = true, | |
| .hso_begin = 79, | |
| .hso_end = 123, | |
| .vso_begin = 79, | |
| .vso_end = 79, | |
| .vso_bline = 0, | |
| .vso_eline = 5, | |
| .vso_eline_present = true, | |
| /* sy_val */ | |
| /* sy2_val */ | |
| .max_lncnt = 1124, | |
| }, | |
| }; | |
| static union meson_hdmi_venc_mode meson_hdmi_encp_mode_1080p60 = { | |
| .encp = { | |
| .dvi_settings = 0x1, | |
| .video_mode = 0x4040, | |
| .video_mode_adv = 0x18, | |
| .video_prog_mode = 0x100, | |
| .video_prog_mode_present = true, | |
| /* video_sync_mode */ | |
| /* video_yc_dly */ | |
| /* video_rgb_ctrl */ | |
| .video_filt_ctrl = 0x1052, | |
| .video_filt_ctrl_present = true, | |
| /* video_ofld_voav_ofst */ | |
| .yfp1_htime = 140, | |
| .yfp2_htime = 2060, | |
| .max_pxcnt = 2199, | |
| .hspuls_begin = 2156, | |
| .hspuls_end = 44, | |
| .hspuls_switch = 44, | |
| .vspuls_begin = 140, | |
| .vspuls_end = 2059, | |
| .vspuls_bline = 0, | |
| .vspuls_eline = 4, | |
| .havon_begin = 148, | |
| .havon_end = 2067, | |
| .vavon_bline = 41, | |
| .vavon_eline = 1120, | |
| /* eqpuls_begin */ | |
| /* eqpuls_end */ | |
| /* eqpuls_bline */ | |
| /* eqpuls_eline */ | |
| .hso_begin = 44, | |
| .hso_end = 2156, | |
| .vso_begin = 2100, | |
| .vso_end = 2164, | |
| .vso_bline = 0, | |
| .vso_eline = 5, | |
| .vso_eline_present = true, | |
| /* sy_val */ | |
| /* sy2_val */ | |
| .max_lncnt = 1124, | |
| }, | |
| }; | |
| static union meson_hdmi_venc_mode meson_hdmi_encp_mode_2160p24 = { | |
| .encp = { | |
| .dvi_settings = 0x1, | |
| .video_mode = 0x4040, | |
| .video_mode_adv = 0x8, | |
| /* video_sync_mode */ | |
| /* video_yc_dly */ | |
| /* video_rgb_ctrl */ | |
| .video_filt_ctrl = 0x1000, | |
| .video_filt_ctrl_present = true, | |
| /* video_ofld_voav_ofst */ | |
| .yfp1_htime = 140, | |
| .yfp2_htime = 140+3840, | |
| .max_pxcnt = 3840+1660-1, | |
| .hspuls_begin = 2156+1920, | |
| .hspuls_end = 44, | |
| .hspuls_switch = 44, | |
| .vspuls_begin = 140, | |
| .vspuls_end = 2059+1920, | |
| .vspuls_bline = 0, | |
| .vspuls_eline = 4, | |
| .havon_begin = 148, | |
| .havon_end = 3987, | |
| .vavon_bline = 89, | |
| .vavon_eline = 2248, | |
| /* eqpuls_begin */ | |
| /* eqpuls_end */ | |
| /* eqpuls_bline */ | |
| /* eqpuls_eline */ | |
| .hso_begin = 44, | |
| .hso_end = 2156+1920, | |
| .vso_begin = 2100+1920, | |
| .vso_end = 2164+1920, | |
| .vso_bline = 51, | |
| .vso_eline = 53, | |
| .vso_eline_present = true, | |
| /* sy_val */ | |
| /* sy2_val */ | |
| .max_lncnt = 2249, | |
| }, | |
| }; | |
| static union meson_hdmi_venc_mode meson_hdmi_encp_mode_2160p25 = { | |
| .encp = { | |
| .dvi_settings = 0x1, | |
| .video_mode = 0x4040, | |
| .video_mode_adv = 0x8, | |
| /* video_sync_mode */ | |
| /* video_yc_dly */ | |
| /* video_rgb_ctrl */ | |
| .video_filt_ctrl = 0x1000, | |
| .video_filt_ctrl_present = true, | |
| /* video_ofld_voav_ofst */ | |
| .yfp1_htime = 140, | |
| .yfp2_htime = 140+3840, | |
| .max_pxcnt = 3840+1440-1, | |
| .hspuls_begin = 2156+1920, | |
| .hspuls_end = 44, | |
| .hspuls_switch = 44, | |
| .vspuls_begin = 140, | |
| .vspuls_end = 2059+1920, | |
| .vspuls_bline = 0, | |
| .vspuls_eline = 4, | |
| .havon_begin = 148, | |
| .havon_end = 3987, | |
| .vavon_bline = 89, | |
| .vavon_eline = 2248, | |
| /* eqpuls_begin */ | |
| /* eqpuls_end */ | |
| /* eqpuls_bline */ | |
| /* eqpuls_eline */ | |
| .hso_begin = 44, | |
| .hso_end = 2156+1920, | |
| .vso_begin = 2100+1920, | |
| .vso_end = 2164+1920, | |
| .vso_bline = 51, | |
| .vso_eline = 53, | |
| .vso_eline_present = true, | |
| /* sy_val */ | |
| /* sy2_val */ | |
| .max_lncnt = 2249, | |
| }, | |
| }; | |
| static union meson_hdmi_venc_mode meson_hdmi_encp_mode_2160p30 = { | |
| .encp = { | |
| .dvi_settings = 0x1, | |
| .video_mode = 0x4040, | |
| .video_mode_adv = 0x8, | |
| /* video_sync_mode */ | |
| /* video_yc_dly */ | |
| /* video_rgb_ctrl */ | |
| .video_filt_ctrl = 0x1000, | |
| .video_filt_ctrl_present = true, | |
| /* video_ofld_voav_ofst */ | |
| .yfp1_htime = 140, | |
| .yfp2_htime = 140+3840, | |
| .max_pxcnt = 3840+560-1, | |
| .hspuls_begin = 2156+1920, | |
| .hspuls_end = 44, | |
| .hspuls_switch = 44, | |
| .vspuls_begin = 140, | |
| .vspuls_end = 2059+1920, | |
| .vspuls_bline = 0, | |
| .vspuls_eline = 4, | |
| .havon_begin = 148, | |
| .havon_end = 3987, | |
| .vavon_bline = 89, | |
| .vavon_eline = 2248, | |
| /* eqpuls_begin */ | |
| /* eqpuls_end */ | |
| /* eqpuls_bline */ | |
| /* eqpuls_eline */ | |
| .hso_begin = 44, | |
| .hso_end = 2156+1920, | |
| .vso_begin = 2100+1920, | |
| .vso_end = 2164+1920, | |
| .vso_bline = 51, | |
| .vso_eline = 53, | |
| .vso_eline_present = true, | |
| /* sy_val */ | |
| /* sy2_val */ | |
| .max_lncnt = 2249, | |
| }, | |
| }; | |
| static struct meson_hdmi_venc_vic_mode { | |
| unsigned int vic; | |
| union meson_hdmi_venc_mode *mode; | |
| } meson_hdmi_venc_vic_modes[] = { | |
| { 6, &meson_hdmi_enci_mode_480i }, | |
| { 7, &meson_hdmi_enci_mode_480i }, | |
| { 21, &meson_hdmi_enci_mode_576i }, | |
| { 22, &meson_hdmi_enci_mode_576i }, | |
| { 2, &meson_hdmi_encp_mode_480p }, | |
| { 3, &meson_hdmi_encp_mode_480p }, | |
| { 17, &meson_hdmi_encp_mode_576p }, | |
| { 18, &meson_hdmi_encp_mode_576p }, | |
| { 4, &meson_hdmi_encp_mode_720p60 }, | |
| { 19, &meson_hdmi_encp_mode_720p50 }, | |
| { 5, &meson_hdmi_encp_mode_1080i60 }, | |
| { 20, &meson_hdmi_encp_mode_1080i50 }, | |
| { 32, &meson_hdmi_encp_mode_1080p24 }, | |
| { 33, &meson_hdmi_encp_mode_1080p50 }, | |
| { 34, &meson_hdmi_encp_mode_1080p30 }, | |
| { 31, &meson_hdmi_encp_mode_1080p50 }, | |
| { 16, &meson_hdmi_encp_mode_1080p60 }, | |
| { 93, &meson_hdmi_encp_mode_2160p24 }, | |
| { 94, &meson_hdmi_encp_mode_2160p25 }, | |
| { 95, &meson_hdmi_encp_mode_2160p30 }, | |
| { 96, &meson_hdmi_encp_mode_2160p25 }, | |
| { 97, &meson_hdmi_encp_mode_2160p30 }, | |
| { 0, NULL}, /* sentinel */ | |
| }; | |
| static signed int to_signed(unsigned int a) | |
| { | |
| if (a <= 7) | |
| return a; | |
| else | |
| return a - 16; | |
| } | |
| static unsigned long modulo(unsigned long a, unsigned long b) | |
| { | |
| if (a >= b) | |
| return a - b; | |
| else | |
| return a; | |
| } | |
| enum drm_mode_status | |
| meson_venc_hdmi_supported_mode(const struct drm_display_mode *mode) | |
| { | |
| if (mode->flags & ~(DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_NHSYNC | | |
| DRM_MODE_FLAG_PVSYNC | DRM_MODE_FLAG_NVSYNC)) | |
| return MODE_BAD; | |
| if (mode->hdisplay < 400 || mode->hdisplay > 3840) | |
| return MODE_BAD_HVALUE; | |
| if (mode->vdisplay < 480 || mode->vdisplay > 2160) | |
| return MODE_BAD_VVALUE; | |
| return MODE_OK; | |
| } | |
| EXPORT_SYMBOL_GPL(meson_venc_hdmi_supported_mode); | |
| bool meson_venc_hdmi_supported_vic(int vic) | |
| { | |
| struct meson_hdmi_venc_vic_mode *vmode = meson_hdmi_venc_vic_modes; | |
| while (vmode->vic && vmode->mode) { | |
| if (vmode->vic == vic) | |
| return true; | |
| vmode++; | |
| } | |
| return false; | |
| } | |
| EXPORT_SYMBOL_GPL(meson_venc_hdmi_supported_vic); | |
| static void meson_venc_hdmi_get_dmt_vmode(const struct drm_display_mode *mode, | |
| union meson_hdmi_venc_mode *dmt_mode) | |
| { | |
| memset(dmt_mode, 0, sizeof(*dmt_mode)); | |
| dmt_mode->encp.dvi_settings = 0x21; | |
| dmt_mode->encp.video_mode = 0x4040; | |
| dmt_mode->encp.video_mode_adv = 0x18; | |
| dmt_mode->encp.max_pxcnt = mode->htotal - 1; | |
| dmt_mode->encp.havon_begin = mode->htotal - mode->hsync_start; | |
| dmt_mode->encp.havon_end = dmt_mode->encp.havon_begin + | |
| mode->hdisplay - 1; | |
| dmt_mode->encp.vavon_bline = mode->vtotal - mode->vsync_start; | |
| dmt_mode->encp.vavon_eline = dmt_mode->encp.vavon_bline + | |
| mode->vdisplay - 1; | |
| dmt_mode->encp.hso_begin = 0; | |
| dmt_mode->encp.hso_end = mode->hsync_end - mode->hsync_start; | |
| dmt_mode->encp.vso_begin = 30; | |
| dmt_mode->encp.vso_end = 50; | |
| dmt_mode->encp.vso_bline = 0; | |
| dmt_mode->encp.vso_eline = mode->vsync_end - mode->vsync_start; | |
| dmt_mode->encp.vso_eline_present = true; | |
| dmt_mode->encp.max_lncnt = mode->vtotal - 1; | |
| } | |
| static union meson_hdmi_venc_mode *meson_venc_hdmi_get_vic_vmode(int vic) | |
| { | |
| struct meson_hdmi_venc_vic_mode *vmode = meson_hdmi_venc_vic_modes; | |
| while (vmode->vic && vmode->mode) { | |
| if (vmode->vic == vic) | |
| return vmode->mode; | |
| vmode++; | |
| } | |
| return NULL; | |
| } | |
| bool meson_venc_hdmi_venc_repeat(int vic) | |
| { | |
| /* Repeat VENC pixels for 480/576i/p, 720p50/60 and 1080p50/60 */ | |
| if (vic == 6 || vic == 7 || /* 480i */ | |
| vic == 21 || vic == 22 || /* 576i */ | |
| vic == 17 || vic == 18 || /* 576p */ | |
| vic == 2 || vic == 3 || /* 480p */ | |
| vic == 4 || /* 720p60 */ | |
| vic == 19 || /* 720p50 */ | |
| vic == 5 || /* 1080i60 */ | |
| vic == 20) /* 1080i50 */ | |
| return true; | |
| return false; | |
| } | |
| EXPORT_SYMBOL_GPL(meson_venc_hdmi_venc_repeat); | |
| void meson_venc_hdmi_mode_set(struct meson_drm *priv, int vic, | |
| unsigned int ycrcb_map, | |
| bool yuv420_mode, | |
| const struct drm_display_mode *mode) | |
| { | |
| union meson_hdmi_venc_mode *vmode = NULL; | |
| union meson_hdmi_venc_mode vmode_dmt; | |
| bool use_enci = false; | |
| bool venc_repeat = false; | |
| bool hdmi_repeat = false; | |
| unsigned int venc_hdmi_latency = 2; | |
| unsigned long total_pixels_venc = 0; | |
| unsigned long active_pixels_venc = 0; | |
| unsigned long front_porch_venc = 0; | |
| unsigned long hsync_pixels_venc = 0; | |
| unsigned long de_h_begin = 0; | |
| unsigned long de_h_end = 0; | |
| unsigned long de_v_begin_even = 0; | |
| unsigned long de_v_end_even = 0; | |
| unsigned long de_v_begin_odd = 0; | |
| unsigned long de_v_end_odd = 0; | |
| unsigned long hs_begin = 0; | |
| unsigned long hs_end = 0; | |
| unsigned long vs_adjust = 0; | |
| unsigned long vs_bline_evn = 0; | |
| unsigned long vs_eline_evn = 0; | |
| unsigned long vs_bline_odd = 0; | |
| unsigned long vs_eline_odd = 0; | |
| unsigned long vso_begin_evn = 0; | |
| unsigned long vso_begin_odd = 0; | |
| unsigned int eof_lines; | |
| unsigned int sof_lines; | |
| unsigned int vsync_lines; | |
| u32 reg; | |
| /* Use VENCI for 480i and 576i and double HDMI pixels */ | |
| if (mode->flags & DRM_MODE_FLAG_DBLCLK) { | |
| hdmi_repeat = true; | |
| use_enci = true; | |
| venc_hdmi_latency = 1; | |
| } | |
| if (meson_venc_hdmi_supported_vic(vic)) { | |
| vmode = meson_venc_hdmi_get_vic_vmode(vic); | |
| if (!vmode) { | |
| dev_err(priv->dev, "%s: Fatal Error, unsupported mode " | |
| DRM_MODE_FMT "\n", __func__, | |
| DRM_MODE_ARG(mode)); | |
| return; | |
| } | |
| } else { | |
| meson_venc_hdmi_get_dmt_vmode(mode, &vmode_dmt); | |
| vmode = &vmode_dmt; | |
| use_enci = false; | |
| } | |
| /* Repeat VENC pixels for 480/576i/p, 720p50/60 and 1080p50/60 */ | |
| if (meson_venc_hdmi_venc_repeat(vic)) | |
| venc_repeat = true; | |
| eof_lines = mode->vsync_start - mode->vdisplay; | |
| if (mode->flags & DRM_MODE_FLAG_INTERLACE) | |
| eof_lines /= 2; | |
| sof_lines = mode->vtotal - mode->vsync_end; | |
| if (mode->flags & DRM_MODE_FLAG_INTERLACE) | |
| sof_lines /= 2; | |
| vsync_lines = mode->vsync_end - mode->vsync_start; | |
| if (mode->flags & DRM_MODE_FLAG_INTERLACE) | |
| vsync_lines /= 2; | |
| total_pixels_venc = mode->htotal; | |
| if (hdmi_repeat) | |
| total_pixels_venc /= 2; | |
| if (venc_repeat) | |
| total_pixels_venc *= 2; | |
| active_pixels_venc = mode->hdisplay; | |
| if (hdmi_repeat) | |
| active_pixels_venc /= 2; | |
| if (venc_repeat) | |
| active_pixels_venc *= 2; | |
| front_porch_venc = (mode->hsync_start - mode->hdisplay); | |
| if (hdmi_repeat) | |
| front_porch_venc /= 2; | |
| if (venc_repeat) | |
| front_porch_venc *= 2; | |
| hsync_pixels_venc = (mode->hsync_end - mode->hsync_start); | |
| if (hdmi_repeat) | |
| hsync_pixels_venc /= 2; | |
| if (venc_repeat) | |
| hsync_pixels_venc *= 2; | |
| /* Disable VDACs */ | |
| writel_bits_relaxed(0xff, 0xff, | |
| priv->io_base + _REG(VENC_VDAC_SETTING)); | |
| writel_relaxed(0, priv->io_base + _REG(ENCI_VIDEO_EN)); | |
| writel_relaxed(0, priv->io_base + _REG(ENCP_VIDEO_EN)); | |
| if (use_enci) { | |
| unsigned int lines_f0; | |
| unsigned int lines_f1; | |
| /* CVBS Filter settings */ | |
| writel_relaxed(ENCI_CFILT_CMPT_SEL_HIGH | 0x10, | |
| priv->io_base + _REG(ENCI_CFILT_CTRL)); | |
| writel_relaxed(ENCI_CFILT_CMPT_CR_DLY(2) | | |
| ENCI_CFILT_CMPT_CB_DLY(1), | |
| priv->io_base + _REG(ENCI_CFILT_CTRL2)); | |
| /* Digital Video Select : Interlace, clk27 clk, external */ | |
| writel_relaxed(0, priv->io_base + _REG(VENC_DVI_SETTING)); | |
| /* Reset Video Mode */ | |
| writel_relaxed(0, priv->io_base + _REG(ENCI_VIDEO_MODE)); | |
| writel_relaxed(0, priv->io_base + _REG(ENCI_VIDEO_MODE_ADV)); | |
| /* Horizontal sync signal output */ | |
| writel_relaxed(vmode->enci.hso_begin, | |
| priv->io_base + _REG(ENCI_SYNC_HSO_BEGIN)); | |
| writel_relaxed(vmode->enci.hso_end, | |
| priv->io_base + _REG(ENCI_SYNC_HSO_END)); | |
| /* Vertical Sync lines */ | |
| writel_relaxed(vmode->enci.vso_even, | |
| priv->io_base + _REG(ENCI_SYNC_VSO_EVNLN)); | |
| writel_relaxed(vmode->enci.vso_odd, | |
| priv->io_base + _REG(ENCI_SYNC_VSO_ODDLN)); | |
| /* Macrovision max amplitude change */ | |
| writel_relaxed(ENCI_MACV_MAX_AMP_ENABLE_CHANGE | | |
| ENCI_MACV_MAX_AMP_VAL(vmode->enci.macv_max_amp), | |
| priv->io_base + _REG(ENCI_MACV_MAX_AMP)); | |
| /* Video mode */ | |
| writel_relaxed(vmode->enci.video_prog_mode, | |
| priv->io_base + _REG(VENC_VIDEO_PROG_MODE)); | |
| writel_relaxed(vmode->enci.video_mode, | |
| priv->io_base + _REG(ENCI_VIDEO_MODE)); | |
| /* | |
| * Advanced Video Mode : | |
| * Demux shifting 0x2 | |
| * Blank line end at line17/22 | |
| * High bandwidth Luma Filter | |
| * Low bandwidth Chroma Filter | |
| * Bypass luma low pass filter | |
| * No macrovision on CSYNC | |
| */ | |
| writel_relaxed(ENCI_VIDEO_MODE_ADV_DMXMD(2) | | |
| ENCI_VIDEO_MODE_ADV_VBICTL_LINE_17_22 | | |
| ENCI_VIDEO_MODE_ADV_YBW_HIGH, | |
| priv->io_base + _REG(ENCI_VIDEO_MODE_ADV)); | |
| writel(vmode->enci.sch_adjust, | |
| priv->io_base + _REG(ENCI_VIDEO_SCH)); | |
| /* Sync mode : MASTER Master mode, free run, send HSO/VSO out */ | |
| writel_relaxed(0x07, priv->io_base + _REG(ENCI_SYNC_MODE)); | |
| if (vmode->enci.yc_delay) | |
| writel_relaxed(vmode->enci.yc_delay, | |
| priv->io_base + _REG(ENCI_YC_DELAY)); | |
| /* UNreset Interlaced TV Encoder */ | |
| writel_relaxed(0, priv->io_base + _REG(ENCI_DBG_PX_RST)); | |
| /* | |
| * Enable Vfifo2vd and set Y_Cb_Y_Cr: | |
| * Corresponding value: | |
| * Y => 00 or 10 | |
| * Cb => 01 | |
| * Cr => 11 | |
| * Ex: 0x4e => 01001110 would mean Cb/Y/Cr/Y | |
| */ | |
| writel_relaxed(ENCI_VFIFO2VD_CTL_ENABLE | | |
| ENCI_VFIFO2VD_CTL_VD_SEL(0x4e), | |
| priv->io_base + _REG(ENCI_VFIFO2VD_CTL)); | |
| /* Timings */ | |
| writel_relaxed(vmode->enci.pixel_start, | |
| priv->io_base + _REG(ENCI_VFIFO2VD_PIXEL_START)); | |
| writel_relaxed(vmode->enci.pixel_end, | |
| priv->io_base + _REG(ENCI_VFIFO2VD_PIXEL_END)); | |
| writel_relaxed(vmode->enci.top_field_line_start, | |
| priv->io_base + _REG(ENCI_VFIFO2VD_LINE_TOP_START)); | |
| writel_relaxed(vmode->enci.top_field_line_end, | |
| priv->io_base + _REG(ENCI_VFIFO2VD_LINE_TOP_END)); | |
| writel_relaxed(vmode->enci.bottom_field_line_start, | |
| priv->io_base + _REG(ENCI_VFIFO2VD_LINE_BOT_START)); | |
| writel_relaxed(vmode->enci.bottom_field_line_end, | |
| priv->io_base + _REG(ENCI_VFIFO2VD_LINE_BOT_END)); | |
| /* Select ENCI for VIU */ | |
| meson_vpp_setup_mux(priv, MESON_VIU_VPP_MUX_ENCI); | |
| /* Interlace video enable */ | |
| writel_relaxed(ENCI_VIDEO_EN_ENABLE, | |
| priv->io_base + _REG(ENCI_VIDEO_EN)); | |
| lines_f0 = mode->vtotal >> 1; | |
| lines_f1 = lines_f0 + 1; | |
| de_h_begin = modulo(readl_relaxed(priv->io_base + | |
| _REG(ENCI_VFIFO2VD_PIXEL_START)) | |
| + venc_hdmi_latency, | |
| total_pixels_venc); | |
| de_h_end = modulo(de_h_begin + active_pixels_venc, | |
| total_pixels_venc); | |
| writel_relaxed(de_h_begin, | |
| priv->io_base + _REG(ENCI_DE_H_BEGIN)); | |
| writel_relaxed(de_h_end, | |
| priv->io_base + _REG(ENCI_DE_H_END)); | |
| de_v_begin_even = readl_relaxed(priv->io_base + | |
| _REG(ENCI_VFIFO2VD_LINE_TOP_START)); | |
| de_v_end_even = de_v_begin_even + mode->vdisplay; | |
| de_v_begin_odd = readl_relaxed(priv->io_base + | |
| _REG(ENCI_VFIFO2VD_LINE_BOT_START)); | |
| de_v_end_odd = de_v_begin_odd + mode->vdisplay; | |
| writel_relaxed(de_v_begin_even, | |
| priv->io_base + _REG(ENCI_DE_V_BEGIN_EVEN)); | |
| writel_relaxed(de_v_end_even, | |
| priv->io_base + _REG(ENCI_DE_V_END_EVEN)); | |
| writel_relaxed(de_v_begin_odd, | |
| priv->io_base + _REG(ENCI_DE_V_BEGIN_ODD)); | |
| writel_relaxed(de_v_end_odd, | |
| priv->io_base + _REG(ENCI_DE_V_END_ODD)); | |
| /* Program Hsync timing */ | |
| hs_begin = de_h_end + front_porch_venc; | |
| if (de_h_end + front_porch_venc >= total_pixels_venc) { | |
| hs_begin -= total_pixels_venc; | |
| vs_adjust = 1; | |
| } else { | |
| hs_begin = de_h_end + front_porch_venc; | |
| vs_adjust = 0; | |
| } | |
| hs_end = modulo(hs_begin + hsync_pixels_venc, | |
| total_pixels_venc); | |
| writel_relaxed(hs_begin, | |
| priv->io_base + _REG(ENCI_DVI_HSO_BEGIN)); | |
| writel_relaxed(hs_end, | |
| priv->io_base + _REG(ENCI_DVI_HSO_END)); | |
| /* Program Vsync timing for even field */ | |
| if (((de_v_end_odd - 1) + eof_lines + vs_adjust) >= lines_f1) { | |
| vs_bline_evn = (de_v_end_odd - 1) | |
| + eof_lines | |
| + vs_adjust | |
| - lines_f1; | |
| vs_eline_evn = vs_bline_evn + vsync_lines; | |
| writel_relaxed(vs_bline_evn, | |
| priv->io_base + _REG(ENCI_DVI_VSO_BLINE_EVN)); | |
| writel_relaxed(vs_eline_evn, | |
| priv->io_base + _REG(ENCI_DVI_VSO_ELINE_EVN)); | |
| writel_relaxed(hs_begin, | |
| priv->io_base + _REG(ENCI_DVI_VSO_BEGIN_EVN)); | |
| writel_relaxed(hs_begin, | |
| priv->io_base + _REG(ENCI_DVI_VSO_END_EVN)); | |
| } else { | |
| vs_bline_odd = (de_v_end_odd - 1) | |
| + eof_lines | |
| + vs_adjust; | |
| writel_relaxed(vs_bline_odd, | |
| priv->io_base + _REG(ENCI_DVI_VSO_BLINE_ODD)); | |
| writel_relaxed(hs_begin, | |
| priv->io_base + _REG(ENCI_DVI_VSO_BEGIN_ODD)); | |
| if ((vs_bline_odd + vsync_lines) >= lines_f1) { | |
| vs_eline_evn = vs_bline_odd | |
| + vsync_lines | |
| - lines_f1; | |
| writel_relaxed(vs_eline_evn, priv->io_base | |
| + _REG(ENCI_DVI_VSO_ELINE_EVN)); | |
| writel_relaxed(hs_begin, priv->io_base | |
| + _REG(ENCI_DVI_VSO_END_EVN)); | |
| } else { | |
| vs_eline_odd = vs_bline_odd | |
| + vsync_lines; | |
| writel_relaxed(vs_eline_odd, priv->io_base | |
| + _REG(ENCI_DVI_VSO_ELINE_ODD)); | |
| writel_relaxed(hs_begin, priv->io_base | |
| + _REG(ENCI_DVI_VSO_END_ODD)); | |
| } | |
| } | |
| /* Program Vsync timing for odd field */ | |
| if (((de_v_end_even - 1) + (eof_lines + 1)) >= lines_f0) { | |
| vs_bline_odd = (de_v_end_even - 1) | |
| + (eof_lines + 1) | |
| - lines_f0; | |
| vs_eline_odd = vs_bline_odd + vsync_lines; | |
| writel_relaxed(vs_bline_odd, | |
| priv->io_base + _REG(ENCI_DVI_VSO_BLINE_ODD)); | |
| writel_relaxed(vs_eline_odd, | |
| priv->io_base + _REG(ENCI_DVI_VSO_ELINE_ODD)); | |
| vso_begin_odd = modulo(hs_begin | |
| + (total_pixels_venc >> 1), | |
| total_pixels_venc); | |
| writel_relaxed(vso_begin_odd, | |
| priv->io_base + _REG(ENCI_DVI_VSO_BEGIN_ODD)); | |
| writel_relaxed(vso_begin_odd, | |
| priv->io_base + _REG(ENCI_DVI_VSO_END_ODD)); | |
| } else { | |
| vs_bline_evn = (de_v_end_even - 1) | |
| + (eof_lines + 1); | |
| writel_relaxed(vs_bline_evn, | |
| priv->io_base + _REG(ENCI_DVI_VSO_BLINE_EVN)); | |
| vso_begin_evn = modulo(hs_begin | |
| + (total_pixels_venc >> 1), | |
| total_pixels_venc); | |
| writel_relaxed(vso_begin_evn, priv->io_base | |
| + _REG(ENCI_DVI_VSO_BEGIN_EVN)); | |
| if (vs_bline_evn + vsync_lines >= lines_f0) { | |
| vs_eline_odd = vs_bline_evn | |
| + vsync_lines | |
| - lines_f0; | |
| writel_relaxed(vs_eline_odd, priv->io_base | |
| + _REG(ENCI_DVI_VSO_ELINE_ODD)); | |
| writel_relaxed(vso_begin_evn, priv->io_base | |
| + _REG(ENCI_DVI_VSO_END_ODD)); | |
| } else { | |
| vs_eline_evn = vs_bline_evn + vsync_lines; | |
| writel_relaxed(vs_eline_evn, priv->io_base | |
| + _REG(ENCI_DVI_VSO_ELINE_EVN)); | |
| writel_relaxed(vso_begin_evn, priv->io_base | |
| + _REG(ENCI_DVI_VSO_END_EVN)); | |
| } | |
| } | |
| } else { | |
| writel_relaxed(vmode->encp.dvi_settings, | |
| priv->io_base + _REG(VENC_DVI_SETTING)); | |
| writel_relaxed(vmode->encp.video_mode, | |
| priv->io_base + _REG(ENCP_VIDEO_MODE)); | |
| writel_relaxed(vmode->encp.video_mode_adv, | |
| priv->io_base + _REG(ENCP_VIDEO_MODE_ADV)); | |
| if (vmode->encp.video_prog_mode_present) | |
| writel_relaxed(vmode->encp.video_prog_mode, | |
| priv->io_base + _REG(VENC_VIDEO_PROG_MODE)); | |
| if (vmode->encp.video_sync_mode_present) | |
| writel_relaxed(vmode->encp.video_sync_mode, | |
| priv->io_base + _REG(ENCP_VIDEO_SYNC_MODE)); | |
| if (vmode->encp.video_yc_dly_present) | |
| writel_relaxed(vmode->encp.video_yc_dly, | |
| priv->io_base + _REG(ENCP_VIDEO_YC_DLY)); | |
| if (vmode->encp.video_rgb_ctrl_present) | |
| writel_relaxed(vmode->encp.video_rgb_ctrl, | |
| priv->io_base + _REG(ENCP_VIDEO_RGB_CTRL)); | |
| if (vmode->encp.video_filt_ctrl_present) | |
| writel_relaxed(vmode->encp.video_filt_ctrl, | |
| priv->io_base + _REG(ENCP_VIDEO_FILT_CTRL)); | |
| if (vmode->encp.video_ofld_voav_ofst_present) | |
| writel_relaxed(vmode->encp.video_ofld_voav_ofst, | |
| priv->io_base | |
| + _REG(ENCP_VIDEO_OFLD_VOAV_OFST)); | |
| writel_relaxed(vmode->encp.yfp1_htime, | |
| priv->io_base + _REG(ENCP_VIDEO_YFP1_HTIME)); | |
| writel_relaxed(vmode->encp.yfp2_htime, | |
| priv->io_base + _REG(ENCP_VIDEO_YFP2_HTIME)); | |
| writel_relaxed(vmode->encp.max_pxcnt, | |
| priv->io_base + _REG(ENCP_VIDEO_MAX_PXCNT)); | |
| writel_relaxed(vmode->encp.hspuls_begin, | |
| priv->io_base + _REG(ENCP_VIDEO_HSPULS_BEGIN)); | |
| writel_relaxed(vmode->encp.hspuls_end, | |
| priv->io_base + _REG(ENCP_VIDEO_HSPULS_END)); | |
| writel_relaxed(vmode->encp.hspuls_switch, | |
| priv->io_base + _REG(ENCP_VIDEO_HSPULS_SWITCH)); | |
| writel_relaxed(vmode->encp.vspuls_begin, | |
| priv->io_base + _REG(ENCP_VIDEO_VSPULS_BEGIN)); | |
| writel_relaxed(vmode->encp.vspuls_end, | |
| priv->io_base + _REG(ENCP_VIDEO_VSPULS_END)); | |
| writel_relaxed(vmode->encp.vspuls_bline, | |
| priv->io_base + _REG(ENCP_VIDEO_VSPULS_BLINE)); | |
| writel_relaxed(vmode->encp.vspuls_eline, | |
| priv->io_base + _REG(ENCP_VIDEO_VSPULS_ELINE)); | |
| if (vmode->encp.eqpuls_begin_present) | |
| writel_relaxed(vmode->encp.eqpuls_begin, | |
| priv->io_base + _REG(ENCP_VIDEO_EQPULS_BEGIN)); | |
| if (vmode->encp.eqpuls_end_present) | |
| writel_relaxed(vmode->encp.eqpuls_end, | |
| priv->io_base + _REG(ENCP_VIDEO_EQPULS_END)); | |
| if (vmode->encp.eqpuls_bline_present) | |
| writel_relaxed(vmode->encp.eqpuls_bline, | |
| priv->io_base + _REG(ENCP_VIDEO_EQPULS_BLINE)); | |
| if (vmode->encp.eqpuls_eline_present) | |
| writel_relaxed(vmode->encp.eqpuls_eline, | |
| priv->io_base + _REG(ENCP_VIDEO_EQPULS_ELINE)); | |
| writel_relaxed(vmode->encp.havon_begin, | |
| priv->io_base + _REG(ENCP_VIDEO_HAVON_BEGIN)); | |
| writel_relaxed(vmode->encp.havon_end, | |
| priv->io_base + _REG(ENCP_VIDEO_HAVON_END)); | |
| writel_relaxed(vmode->encp.vavon_bline, | |
| priv->io_base + _REG(ENCP_VIDEO_VAVON_BLINE)); | |
| writel_relaxed(vmode->encp.vavon_eline, | |
| priv->io_base + _REG(ENCP_VIDEO_VAVON_ELINE)); | |
| writel_relaxed(vmode->encp.hso_begin, | |
| priv->io_base + _REG(ENCP_VIDEO_HSO_BEGIN)); | |
| writel_relaxed(vmode->encp.hso_end, | |
| priv->io_base + _REG(ENCP_VIDEO_HSO_END)); | |
| writel_relaxed(vmode->encp.vso_begin, | |
| priv->io_base + _REG(ENCP_VIDEO_VSO_BEGIN)); | |
| writel_relaxed(vmode->encp.vso_end, | |
| priv->io_base + _REG(ENCP_VIDEO_VSO_END)); | |
| writel_relaxed(vmode->encp.vso_bline, | |
| priv->io_base + _REG(ENCP_VIDEO_VSO_BLINE)); | |
| if (vmode->encp.vso_eline_present) | |
| writel_relaxed(vmode->encp.vso_eline, | |
| priv->io_base + _REG(ENCP_VIDEO_VSO_ELINE)); | |
| if (vmode->encp.sy_val_present) | |
| writel_relaxed(vmode->encp.sy_val, | |
| priv->io_base + _REG(ENCP_VIDEO_SY_VAL)); | |
| if (vmode->encp.sy2_val_present) | |
| writel_relaxed(vmode->encp.sy2_val, | |
| priv->io_base + _REG(ENCP_VIDEO_SY2_VAL)); | |
| writel_relaxed(vmode->encp.max_lncnt, | |
| priv->io_base + _REG(ENCP_VIDEO_MAX_LNCNT)); | |
| writel_relaxed(1, priv->io_base + _REG(ENCP_VIDEO_EN)); | |
| /* Set DE signal’s polarity is active high */ | |
| writel_bits_relaxed(ENCP_VIDEO_MODE_DE_V_HIGH, | |
| ENCP_VIDEO_MODE_DE_V_HIGH, | |
| priv->io_base + _REG(ENCP_VIDEO_MODE)); | |
| /* Program DE timing */ | |
| de_h_begin = modulo(readl_relaxed(priv->io_base + | |
| _REG(ENCP_VIDEO_HAVON_BEGIN)) | |
| + venc_hdmi_latency, | |
| total_pixels_venc); | |
| de_h_end = modulo(de_h_begin + active_pixels_venc, | |
| total_pixels_venc); | |
| writel_relaxed(de_h_begin, | |
| priv->io_base + _REG(ENCP_DE_H_BEGIN)); | |
| writel_relaxed(de_h_end, | |
| priv->io_base + _REG(ENCP_DE_H_END)); | |
| /* Program DE timing for even field */ | |
| de_v_begin_even = readl_relaxed(priv->io_base | |
| + _REG(ENCP_VIDEO_VAVON_BLINE)); | |
| if (mode->flags & DRM_MODE_FLAG_INTERLACE) | |
| de_v_end_even = de_v_begin_even + | |
| (mode->vdisplay / 2); | |
| else | |
| de_v_end_even = de_v_begin_even + mode->vdisplay; | |
| writel_relaxed(de_v_begin_even, | |
| priv->io_base + _REG(ENCP_DE_V_BEGIN_EVEN)); | |
| writel_relaxed(de_v_end_even, | |
| priv->io_base + _REG(ENCP_DE_V_END_EVEN)); | |
| /* Program DE timing for odd field if needed */ | |
| if (mode->flags & DRM_MODE_FLAG_INTERLACE) { | |
| unsigned int ofld_voav_ofst = | |
| readl_relaxed(priv->io_base + | |
| _REG(ENCP_VIDEO_OFLD_VOAV_OFST)); | |
| de_v_begin_odd = to_signed((ofld_voav_ofst & 0xf0) >> 4) | |
| + de_v_begin_even | |
| + ((mode->vtotal - 1) / 2); | |
| de_v_end_odd = de_v_begin_odd + (mode->vdisplay / 2); | |
| writel_relaxed(de_v_begin_odd, | |
| priv->io_base + _REG(ENCP_DE_V_BEGIN_ODD)); | |
| writel_relaxed(de_v_end_odd, | |
| priv->io_base + _REG(ENCP_DE_V_END_ODD)); | |
| } | |
| /* Program Hsync timing */ | |
| if ((de_h_end + front_porch_venc) >= total_pixels_venc) { | |
| hs_begin = de_h_end | |
| + front_porch_venc | |
| - total_pixels_venc; | |
| vs_adjust = 1; | |
| } else { | |
| hs_begin = de_h_end | |
| + front_porch_venc; | |
| vs_adjust = 0; | |
| } | |
| hs_end = modulo(hs_begin + hsync_pixels_venc, | |
| total_pixels_venc); | |
| writel_relaxed(hs_begin, | |
| priv->io_base + _REG(ENCP_DVI_HSO_BEGIN)); | |
| writel_relaxed(hs_end, | |
| priv->io_base + _REG(ENCP_DVI_HSO_END)); | |
| /* Program Vsync timing for even field */ | |
| if (de_v_begin_even >= | |
| (sof_lines + vsync_lines + (1 - vs_adjust))) | |
| vs_bline_evn = de_v_begin_even | |
| - sof_lines | |
| - vsync_lines | |
| - (1 - vs_adjust); | |
| else | |
| vs_bline_evn = mode->vtotal | |
| + de_v_begin_even | |
| - sof_lines | |
| - vsync_lines | |
| - (1 - vs_adjust); | |
| vs_eline_evn = modulo(vs_bline_evn + vsync_lines, | |
| mode->vtotal); | |
| writel_relaxed(vs_bline_evn, | |
| priv->io_base + _REG(ENCP_DVI_VSO_BLINE_EVN)); | |
| writel_relaxed(vs_eline_evn, | |
| priv->io_base + _REG(ENCP_DVI_VSO_ELINE_EVN)); | |
| vso_begin_evn = hs_begin; | |
| writel_relaxed(vso_begin_evn, | |
| priv->io_base + _REG(ENCP_DVI_VSO_BEGIN_EVN)); | |
| writel_relaxed(vso_begin_evn, | |
| priv->io_base + _REG(ENCP_DVI_VSO_END_EVN)); | |
| /* Program Vsync timing for odd field if needed */ | |
| if (mode->flags & DRM_MODE_FLAG_INTERLACE) { | |
| vs_bline_odd = (de_v_begin_odd - 1) | |
| - sof_lines | |
| - vsync_lines; | |
| vs_eline_odd = (de_v_begin_odd - 1) | |
| - vsync_lines; | |
| vso_begin_odd = modulo(hs_begin | |
| + (total_pixels_venc >> 1), | |
| total_pixels_venc); | |
| writel_relaxed(vs_bline_odd, | |
| priv->io_base + _REG(ENCP_DVI_VSO_BLINE_ODD)); | |
| writel_relaxed(vs_eline_odd, | |
| priv->io_base + _REG(ENCP_DVI_VSO_ELINE_ODD)); | |
| writel_relaxed(vso_begin_odd, | |
| priv->io_base + _REG(ENCP_DVI_VSO_BEGIN_ODD)); | |
| writel_relaxed(vso_begin_odd, | |
| priv->io_base + _REG(ENCP_DVI_VSO_END_ODD)); | |
| } | |
| /* Select ENCP for VIU */ | |
| meson_vpp_setup_mux(priv, MESON_VIU_VPP_MUX_ENCP); | |
| } | |
| /* Set VPU HDMI setting */ | |
| /* Select ENCP or ENCI data to HDMI */ | |
| if (use_enci) | |
| reg = VPU_HDMI_ENCI_DATA_TO_HDMI; | |
| else | |
| reg = VPU_HDMI_ENCP_DATA_TO_HDMI; | |
| /* Invert polarity of HSYNC from VENC */ | |
| if (mode->flags & DRM_MODE_FLAG_PHSYNC) | |
| reg |= VPU_HDMI_INV_HSYNC; | |
| /* Invert polarity of VSYNC from VENC */ | |
| if (mode->flags & DRM_MODE_FLAG_PVSYNC) | |
| reg |= VPU_HDMI_INV_VSYNC; | |
| /* Output data format */ | |
| reg |= ycrcb_map; | |
| /* | |
| * Write rate to the async FIFO between VENC and HDMI. | |
| * One write every 2 wr_clk. | |
| */ | |
| if (venc_repeat || yuv420_mode) | |
| reg |= VPU_HDMI_WR_RATE(2); | |
| /* | |
| * Read rate to the async FIFO between VENC and HDMI. | |
| * One read every 2 wr_clk. | |
| */ | |
| if (hdmi_repeat) | |
| reg |= VPU_HDMI_RD_RATE(2); | |
| writel_relaxed(reg, priv->io_base + _REG(VPU_HDMI_SETTING)); | |
| priv->venc.hdmi_repeat = hdmi_repeat; | |
| priv->venc.venc_repeat = venc_repeat; | |
| priv->venc.hdmi_use_enci = use_enci; | |
| priv->venc.current_mode = MESON_VENC_MODE_HDMI; | |
| } | |
| EXPORT_SYMBOL_GPL(meson_venc_hdmi_mode_set); | |
| static unsigned short meson_encl_gamma_table[256] = { | |
| 0, 4, 8, 12, 16, 20, 24, 28, 32, 36, 40, 44, 48, 52, 56, 60, | |
| 64, 68, 72, 76, 80, 84, 88, 92, 96, 100, 104, 108, 112, 116, 120, 124, | |
| 128, 132, 136, 140, 144, 148, 152, 156, 160, 164, 168, 172, 176, 180, 184, 188, | |
| 192, 196, 200, 204, 208, 212, 216, 220, 224, 228, 232, 236, 240, 244, 248, 252, | |
| 256, 260, 264, 268, 272, 276, 280, 284, 288, 292, 296, 300, 304, 308, 312, 316, | |
| 320, 324, 328, 332, 336, 340, 344, 348, 352, 356, 360, 364, 368, 372, 376, 380, | |
| 384, 388, 392, 396, 400, 404, 408, 412, 416, 420, 424, 428, 432, 436, 440, 444, | |
| 448, 452, 456, 460, 464, 468, 472, 476, 480, 484, 488, 492, 496, 500, 504, 508, | |
| 512, 516, 520, 524, 528, 532, 536, 540, 544, 548, 552, 556, 560, 564, 568, 572, | |
| 576, 580, 584, 588, 592, 596, 600, 604, 608, 612, 616, 620, 624, 628, 632, 636, | |
| 640, 644, 648, 652, 656, 660, 664, 668, 672, 676, 680, 684, 688, 692, 696, 700, | |
| 704, 708, 712, 716, 720, 724, 728, 732, 736, 740, 744, 748, 752, 756, 760, 764, | |
| 768, 772, 776, 780, 784, 788, 792, 796, 800, 804, 808, 812, 816, 820, 824, 828, | |
| 832, 836, 840, 844, 848, 852, 856, 860, 864, 868, 872, 876, 880, 884, 888, 892, | |
| 896, 900, 904, 908, 912, 916, 920, 924, 928, 932, 936, 940, 944, 948, 952, 956, | |
| 960, 964, 968, 972, 976, 980, 984, 988, 992, 996, 1000, 1004, 1008, 1012, 1016, 1020, | |
| }; | |
| static void meson_encl_set_gamma_table(struct meson_drm *priv, u16 *data, | |
| u32 rgb_mask) | |
| { | |
| int i, ret; | |
| u32 reg; | |
| writel_bits_relaxed(L_GAMMA_CNTL_PORT_EN, 0, | |
| priv->io_base + _REG(L_GAMMA_CNTL_PORT)); | |
| ret = readl_relaxed_poll_timeout(priv->io_base + _REG(L_GAMMA_CNTL_PORT), | |
| reg, reg & L_GAMMA_CNTL_PORT_ADR_RDY, 10, 10000); | |
| if (ret) | |
| pr_warn("%s: GAMMA ADR_RDY timeout\n", __func__); | |
| writel_relaxed(L_GAMMA_ADDR_PORT_AUTO_INC | rgb_mask | | |
| FIELD_PREP(L_GAMMA_ADDR_PORT_ADDR, 0), | |
| priv->io_base + _REG(L_GAMMA_ADDR_PORT)); | |
| for (i = 0; i < 256; i++) { | |
| ret = readl_relaxed_poll_timeout(priv->io_base + _REG(L_GAMMA_CNTL_PORT), | |
| reg, reg & L_GAMMA_CNTL_PORT_WR_RDY, | |
| 10, 10000); | |
| if (ret) | |
| pr_warn_once("%s: GAMMA WR_RDY timeout\n", __func__); | |
| writel_relaxed(data[i], priv->io_base + _REG(L_GAMMA_DATA_PORT)); | |
| } | |
| ret = readl_relaxed_poll_timeout(priv->io_base + _REG(L_GAMMA_CNTL_PORT), | |
| reg, reg & L_GAMMA_CNTL_PORT_ADR_RDY, 10, 10000); | |
| if (ret) | |
| pr_warn("%s: GAMMA ADR_RDY timeout\n", __func__); | |
| writel_relaxed(L_GAMMA_ADDR_PORT_AUTO_INC | rgb_mask | | |
| FIELD_PREP(L_GAMMA_ADDR_PORT_ADDR, 0x23), | |
| priv->io_base + _REG(L_GAMMA_ADDR_PORT)); | |
| } | |
| void meson_encl_load_gamma(struct meson_drm *priv) | |
| { | |
| meson_encl_set_gamma_table(priv, meson_encl_gamma_table, L_GAMMA_ADDR_PORT_SEL_R); | |
| meson_encl_set_gamma_table(priv, meson_encl_gamma_table, L_GAMMA_ADDR_PORT_SEL_G); | |
| meson_encl_set_gamma_table(priv, meson_encl_gamma_table, L_GAMMA_ADDR_PORT_SEL_B); | |
| writel_bits_relaxed(L_GAMMA_CNTL_PORT_EN, L_GAMMA_CNTL_PORT_EN, | |
| priv->io_base + _REG(L_GAMMA_CNTL_PORT)); | |
| } | |
| void meson_venc_mipi_dsi_mode_set(struct meson_drm *priv, | |
| const struct drm_display_mode *mode) | |
| { | |
| unsigned int max_pxcnt; | |
| unsigned int max_lncnt; | |
| unsigned int havon_begin; | |
| unsigned int havon_end; | |
| unsigned int vavon_bline; | |
| unsigned int vavon_eline; | |
| unsigned int hso_begin; | |
| unsigned int hso_end; | |
| unsigned int vso_begin; | |
| unsigned int vso_end; | |
| unsigned int vso_bline; | |
| unsigned int vso_eline; | |
| max_pxcnt = mode->htotal - 1; | |
| max_lncnt = mode->vtotal - 1; | |
| havon_begin = mode->htotal - mode->hsync_start; | |
| havon_end = havon_begin + mode->hdisplay - 1; | |
| vavon_bline = mode->vtotal - mode->vsync_start; | |
| vavon_eline = vavon_bline + mode->vdisplay - 1; | |
| hso_begin = 0; | |
| hso_end = mode->hsync_end - mode->hsync_start; | |
| vso_begin = 0; | |
| vso_end = 0; | |
| vso_bline = 0; | |
| vso_eline = mode->vsync_end - mode->vsync_start; | |
| meson_vpp_setup_mux(priv, MESON_VIU_VPP_MUX_ENCL); | |
| writel_relaxed(0, priv->io_base + _REG(ENCL_VIDEO_EN)); | |
| writel_relaxed(ENCL_PX_LN_CNT_SHADOW_EN, priv->io_base + _REG(ENCL_VIDEO_MODE)); | |
| writel_relaxed(ENCL_VIDEO_MODE_ADV_VFIFO_EN | | |
| ENCL_VIDEO_MODE_ADV_GAIN_HDTV | | |
| ENCL_SEL_GAMMA_RGB_IN, priv->io_base + _REG(ENCL_VIDEO_MODE_ADV)); | |
| writel_relaxed(ENCL_VIDEO_FILT_CTRL_BYPASS_FILTER, | |
| priv->io_base + _REG(ENCL_VIDEO_FILT_CTRL)); | |
| writel_relaxed(max_pxcnt, priv->io_base + _REG(ENCL_VIDEO_MAX_PXCNT)); | |
| writel_relaxed(max_lncnt, priv->io_base + _REG(ENCL_VIDEO_MAX_LNCNT)); | |
| writel_relaxed(havon_begin, priv->io_base + _REG(ENCL_VIDEO_HAVON_BEGIN)); | |
| writel_relaxed(havon_end, priv->io_base + _REG(ENCL_VIDEO_HAVON_END)); | |
| writel_relaxed(vavon_bline, priv->io_base + _REG(ENCL_VIDEO_VAVON_BLINE)); | |
| writel_relaxed(vavon_eline, priv->io_base + _REG(ENCL_VIDEO_VAVON_ELINE)); | |
| writel_relaxed(hso_begin, priv->io_base + _REG(ENCL_VIDEO_HSO_BEGIN)); | |
| writel_relaxed(hso_end, priv->io_base + _REG(ENCL_VIDEO_HSO_END)); | |
| writel_relaxed(vso_begin, priv->io_base + _REG(ENCL_VIDEO_VSO_BEGIN)); | |
| writel_relaxed(vso_end, priv->io_base + _REG(ENCL_VIDEO_VSO_END)); | |
| writel_relaxed(vso_bline, priv->io_base + _REG(ENCL_VIDEO_VSO_BLINE)); | |
| writel_relaxed(vso_eline, priv->io_base + _REG(ENCL_VIDEO_VSO_ELINE)); | |
| writel_relaxed(ENCL_VIDEO_RGBIN_RGB | ENCL_VIDEO_RGBIN_ZBLK, | |
| priv->io_base + _REG(ENCL_VIDEO_RGBIN_CTRL)); | |
| /* default black pattern */ | |
| writel_relaxed(0, priv->io_base + _REG(ENCL_TST_MDSEL)); | |
| writel_relaxed(0, priv->io_base + _REG(ENCL_TST_Y)); | |
| writel_relaxed(0, priv->io_base + _REG(ENCL_TST_CB)); | |
| writel_relaxed(0, priv->io_base + _REG(ENCL_TST_CR)); | |
| writel_relaxed(1, priv->io_base + _REG(ENCL_TST_EN)); | |
| writel_bits_relaxed(ENCL_VIDEO_MODE_ADV_VFIFO_EN, 0, | |
| priv->io_base + _REG(ENCL_VIDEO_MODE_ADV)); | |
| writel_relaxed(1, priv->io_base + _REG(ENCL_VIDEO_EN)); | |
| writel_relaxed(0, priv->io_base + _REG(L_RGB_BASE_ADDR)); | |
| writel_relaxed(0x400, priv->io_base + _REG(L_RGB_COEFF_ADDR)); /* Magic value */ | |
| writel_relaxed(L_DITH_CNTL_DITH10_EN, priv->io_base + _REG(L_DITH_CNTL_ADDR)); | |
| /* DE signal for TTL */ | |
| writel_relaxed(havon_begin, priv->io_base + _REG(L_OEH_HS_ADDR)); | |
| writel_relaxed(havon_end + 1, priv->io_base + _REG(L_OEH_HE_ADDR)); | |
| writel_relaxed(vavon_bline, priv->io_base + _REG(L_OEH_VS_ADDR)); | |
| writel_relaxed(vavon_eline, priv->io_base + _REG(L_OEH_VE_ADDR)); | |
| /* DE signal for TTL */ | |
| writel_relaxed(havon_begin, priv->io_base + _REG(L_OEV1_HS_ADDR)); | |
| writel_relaxed(havon_end + 1, priv->io_base + _REG(L_OEV1_HE_ADDR)); | |
| writel_relaxed(vavon_bline, priv->io_base + _REG(L_OEV1_VS_ADDR)); | |
| writel_relaxed(vavon_eline, priv->io_base + _REG(L_OEV1_VE_ADDR)); | |
| /* Hsync signal for TTL */ | |
| if (mode->flags & DRM_MODE_FLAG_PHSYNC) { | |
| writel_relaxed(hso_begin, priv->io_base + _REG(L_STH1_HS_ADDR)); | |
| writel_relaxed(hso_end, priv->io_base + _REG(L_STH1_HE_ADDR)); | |
| } else { | |
| writel_relaxed(hso_end, priv->io_base + _REG(L_STH1_HS_ADDR)); | |
| writel_relaxed(hso_begin, priv->io_base + _REG(L_STH1_HE_ADDR)); | |
| } | |
| writel_relaxed(0, priv->io_base + _REG(L_STH1_VS_ADDR)); | |
| writel_relaxed(max_lncnt, priv->io_base + _REG(L_STH1_VE_ADDR)); | |
| /* Vsync signal for TTL */ | |
| writel_relaxed(vso_begin, priv->io_base + _REG(L_STV1_HS_ADDR)); | |
| writel_relaxed(vso_end, priv->io_base + _REG(L_STV1_HE_ADDR)); | |
| if (mode->flags & DRM_MODE_FLAG_PVSYNC) { | |
| writel_relaxed(vso_bline, priv->io_base + _REG(L_STV1_VS_ADDR)); | |
| writel_relaxed(vso_eline, priv->io_base + _REG(L_STV1_VE_ADDR)); | |
| } else { | |
| writel_relaxed(vso_eline, priv->io_base + _REG(L_STV1_VS_ADDR)); | |
| writel_relaxed(vso_bline, priv->io_base + _REG(L_STV1_VE_ADDR)); | |
| } | |
| /* DE signal */ | |
| writel_relaxed(havon_begin, priv->io_base + _REG(L_DE_HS_ADDR)); | |
| writel_relaxed(havon_end + 1, priv->io_base + _REG(L_DE_HE_ADDR)); | |
| writel_relaxed(vavon_bline, priv->io_base + _REG(L_DE_VS_ADDR)); | |
| writel_relaxed(vavon_eline, priv->io_base + _REG(L_DE_VE_ADDR)); | |
| /* Hsync signal */ | |
| writel_relaxed(hso_begin, priv->io_base + _REG(L_HSYNC_HS_ADDR)); | |
| writel_relaxed(hso_end, priv->io_base + _REG(L_HSYNC_HE_ADDR)); | |
| writel_relaxed(0, priv->io_base + _REG(L_HSYNC_VS_ADDR)); | |
| writel_relaxed(max_lncnt, priv->io_base + _REG(L_HSYNC_VE_ADDR)); | |
| /* Vsync signal */ | |
| writel_relaxed(vso_begin, priv->io_base + _REG(L_VSYNC_HS_ADDR)); | |
| writel_relaxed(vso_end, priv->io_base + _REG(L_VSYNC_HE_ADDR)); | |
| writel_relaxed(vso_bline, priv->io_base + _REG(L_VSYNC_VS_ADDR)); | |
| writel_relaxed(vso_eline, priv->io_base + _REG(L_VSYNC_VE_ADDR)); | |
| writel_relaxed(0, priv->io_base + _REG(L_INV_CNT_ADDR)); | |
| writel_relaxed(L_TCON_MISC_SEL_STV1 | L_TCON_MISC_SEL_STV2, | |
| priv->io_base + _REG(L_TCON_MISC_SEL_ADDR)); | |
| priv->venc.current_mode = MESON_VENC_MODE_MIPI_DSI; | |
| } | |
| EXPORT_SYMBOL_GPL(meson_venc_mipi_dsi_mode_set); | |
| void meson_venci_cvbs_mode_set(struct meson_drm *priv, | |
| struct meson_cvbs_enci_mode *mode) | |
| { | |
| u32 reg; | |
| if (mode->mode_tag == priv->venc.current_mode) | |
| return; | |
| /* CVBS Filter settings */ | |
| writel_relaxed(ENCI_CFILT_CMPT_SEL_HIGH | 0x10, | |
| priv->io_base + _REG(ENCI_CFILT_CTRL)); | |
| writel_relaxed(ENCI_CFILT_CMPT_CR_DLY(2) | | |
| ENCI_CFILT_CMPT_CB_DLY(1), | |
| priv->io_base + _REG(ENCI_CFILT_CTRL2)); | |
| /* Digital Video Select : Interlace, clk27 clk, external */ | |
| writel_relaxed(0, priv->io_base + _REG(VENC_DVI_SETTING)); | |
| /* Reset Video Mode */ | |
| writel_relaxed(0, priv->io_base + _REG(ENCI_VIDEO_MODE)); | |
| writel_relaxed(0, priv->io_base + _REG(ENCI_VIDEO_MODE_ADV)); | |
| /* Horizontal sync signal output */ | |
| writel_relaxed(mode->hso_begin, | |
| priv->io_base + _REG(ENCI_SYNC_HSO_BEGIN)); | |
| writel_relaxed(mode->hso_end, | |
| priv->io_base + _REG(ENCI_SYNC_HSO_END)); | |
| /* Vertical Sync lines */ | |
| writel_relaxed(mode->vso_even, | |
| priv->io_base + _REG(ENCI_SYNC_VSO_EVNLN)); | |
| writel_relaxed(mode->vso_odd, | |
| priv->io_base + _REG(ENCI_SYNC_VSO_ODDLN)); | |
| /* Macrovision max amplitude change */ | |
| writel_relaxed(ENCI_MACV_MAX_AMP_ENABLE_CHANGE | | |
| ENCI_MACV_MAX_AMP_VAL(mode->macv_max_amp), | |
| priv->io_base + _REG(ENCI_MACV_MAX_AMP)); | |
| /* Video mode */ | |
| writel_relaxed(mode->video_prog_mode, | |
| priv->io_base + _REG(VENC_VIDEO_PROG_MODE)); | |
| writel_relaxed(mode->video_mode, | |
| priv->io_base + _REG(ENCI_VIDEO_MODE)); | |
| /* | |
| * Advanced Video Mode : | |
| * Demux shifting 0x2 | |
| * Blank line end at line17/22 | |
| * High bandwidth Luma Filter | |
| * Low bandwidth Chroma Filter | |
| * Bypass luma low pass filter | |
| * No macrovision on CSYNC | |
| */ | |
| writel_relaxed(ENCI_VIDEO_MODE_ADV_DMXMD(2) | | |
| ENCI_VIDEO_MODE_ADV_VBICTL_LINE_17_22 | | |
| ENCI_VIDEO_MODE_ADV_YBW_HIGH, | |
| priv->io_base + _REG(ENCI_VIDEO_MODE_ADV)); | |
| writel(mode->sch_adjust, priv->io_base + _REG(ENCI_VIDEO_SCH)); | |
| /* Sync mode : MASTER Master mode, free run, send HSO/VSO out */ | |
| writel_relaxed(0x07, priv->io_base + _REG(ENCI_SYNC_MODE)); | |
| /* 0x3 Y, C, and Component Y delay */ | |
| writel_relaxed(mode->yc_delay, priv->io_base + _REG(ENCI_YC_DELAY)); | |
| /* Timings */ | |
| writel_relaxed(mode->pixel_start, | |
| priv->io_base + _REG(ENCI_VFIFO2VD_PIXEL_START)); | |
| writel_relaxed(mode->pixel_end, | |
| priv->io_base + _REG(ENCI_VFIFO2VD_PIXEL_END)); | |
| writel_relaxed(mode->top_field_line_start, | |
| priv->io_base + _REG(ENCI_VFIFO2VD_LINE_TOP_START)); | |
| writel_relaxed(mode->top_field_line_end, | |
| priv->io_base + _REG(ENCI_VFIFO2VD_LINE_TOP_END)); | |
| writel_relaxed(mode->bottom_field_line_start, | |
| priv->io_base + _REG(ENCI_VFIFO2VD_LINE_BOT_START)); | |
| writel_relaxed(mode->bottom_field_line_end, | |
| priv->io_base + _REG(ENCI_VFIFO2VD_LINE_BOT_END)); | |
| /* Internal Venc, Internal VIU Sync, Internal Vencoder */ | |
| writel_relaxed(0, priv->io_base + _REG(VENC_SYNC_ROUTE)); | |
| /* UNreset Interlaced TV Encoder */ | |
| writel_relaxed(0, priv->io_base + _REG(ENCI_DBG_PX_RST)); | |
| /* | |
| * Enable Vfifo2vd and set Y_Cb_Y_Cr: | |
| * Corresponding value: | |
| * Y => 00 or 10 | |
| * Cb => 01 | |
| * Cr => 11 | |
| * Ex: 0x4e => 01001110 would mean Cb/Y/Cr/Y | |
| */ | |
| writel_relaxed(ENCI_VFIFO2VD_CTL_ENABLE | | |
| ENCI_VFIFO2VD_CTL_VD_SEL(0x4e), | |
| priv->io_base + _REG(ENCI_VFIFO2VD_CTL)); | |
| /* Power UP Dacs */ | |
| writel_relaxed(0, priv->io_base + _REG(VENC_VDAC_SETTING)); | |
| /* Video Upsampling */ | |
| /* | |
| * CTRL0, CTRL1 and CTRL2: | |
| * Filter0: input data sample every 2 cloks | |
| * Filter1: filtering and upsample enable | |
| */ | |
| reg = VENC_UPSAMPLE_CTRL_F0_2_CLK_RATIO | VENC_UPSAMPLE_CTRL_F1_EN | | |
| VENC_UPSAMPLE_CTRL_F1_UPSAMPLE_EN; | |
| /* | |
| * Upsample CTRL0: | |
| * Interlace High Bandwidth Luma | |
| */ | |
| writel_relaxed(VENC_UPSAMPLE_CTRL_INTERLACE_HIGH_LUMA | reg, | |
| priv->io_base + _REG(VENC_UPSAMPLE_CTRL0)); | |
| /* | |
| * Upsample CTRL1: | |
| * Interlace Pb | |
| */ | |
| writel_relaxed(VENC_UPSAMPLE_CTRL_INTERLACE_PB | reg, | |
| priv->io_base + _REG(VENC_UPSAMPLE_CTRL1)); | |
| /* | |
| * Upsample CTRL2: | |
| * Interlace R | |
| */ | |
| writel_relaxed(VENC_UPSAMPLE_CTRL_INTERLACE_PR | reg, | |
| priv->io_base + _REG(VENC_UPSAMPLE_CTRL2)); | |
| /* Select Interlace Y DACs */ | |
| writel_relaxed(0, priv->io_base + _REG(VENC_VDAC_DACSEL0)); | |
| writel_relaxed(0, priv->io_base + _REG(VENC_VDAC_DACSEL1)); | |
| writel_relaxed(0, priv->io_base + _REG(VENC_VDAC_DACSEL2)); | |
| writel_relaxed(0, priv->io_base + _REG(VENC_VDAC_DACSEL3)); | |
| writel_relaxed(0, priv->io_base + _REG(VENC_VDAC_DACSEL4)); | |
| writel_relaxed(0, priv->io_base + _REG(VENC_VDAC_DACSEL5)); | |
| /* Select ENCI for VIU */ | |
| meson_vpp_setup_mux(priv, MESON_VIU_VPP_MUX_ENCI); | |
| /* Enable ENCI FIFO */ | |
| writel_relaxed(VENC_VDAC_FIFO_EN_ENCI_ENABLE, | |
| priv->io_base + _REG(VENC_VDAC_FIFO_CTRL)); | |
| /* Select ENCI DACs 0, 1, 4, and 5 */ | |
| writel_relaxed(0x11, priv->io_base + _REG(ENCI_DACSEL_0)); | |
| writel_relaxed(0x11, priv->io_base + _REG(ENCI_DACSEL_1)); | |
| /* Interlace video enable */ | |
| writel_relaxed(ENCI_VIDEO_EN_ENABLE, | |
| priv->io_base + _REG(ENCI_VIDEO_EN)); | |
| /* Configure Video Saturation / Contrast / Brightness / Hue */ | |
| writel_relaxed(mode->video_saturation, | |
| priv->io_base + _REG(ENCI_VIDEO_SAT)); | |
| writel_relaxed(mode->video_contrast, | |
| priv->io_base + _REG(ENCI_VIDEO_CONT)); | |
| writel_relaxed(mode->video_brightness, | |
| priv->io_base + _REG(ENCI_VIDEO_BRIGHT)); | |
| writel_relaxed(mode->video_hue, | |
| priv->io_base + _REG(ENCI_VIDEO_HUE)); | |
| /* Enable DAC0 Filter */ | |
| writel_relaxed(VENC_VDAC_DAC0_FILT_CTRL0_EN, | |
| priv->io_base + _REG(VENC_VDAC_DAC0_FILT_CTRL0)); | |
| writel_relaxed(0xfc48, priv->io_base + _REG(VENC_VDAC_DAC0_FILT_CTRL1)); | |
| /* 0 in Macrovision register 0 */ | |
| writel_relaxed(0, priv->io_base + _REG(ENCI_MACV_N0)); | |
| /* Analog Synchronization and color burst value adjust */ | |
| writel_relaxed(mode->analog_sync_adj, | |
| priv->io_base + _REG(ENCI_SYNC_ADJ)); | |
| priv->venc.current_mode = mode->mode_tag; | |
| } | |
| /* Returns the current ENCI field polarity */ | |
| unsigned int meson_venci_get_field(struct meson_drm *priv) | |
| { | |
| return readl_relaxed(priv->io_base + _REG(ENCI_INFO_READ)) & BIT(29); | |
| } | |
| void meson_venc_enable_vsync(struct meson_drm *priv) | |
| { | |
| switch (priv->venc.current_mode) { | |
| case MESON_VENC_MODE_MIPI_DSI: | |
| writel_relaxed(VENC_INTCTRL_ENCP_LNRST_INT_EN, | |
| priv->io_base + _REG(VENC_INTCTRL)); | |
| break; | |
| default: | |
| writel_relaxed(VENC_INTCTRL_ENCI_LNRST_INT_EN, | |
| priv->io_base + _REG(VENC_INTCTRL)); | |
| } | |
| regmap_update_bits(priv->hhi, HHI_GCLK_MPEG2, BIT(25), BIT(25)); | |
| } | |
| void meson_venc_disable_vsync(struct meson_drm *priv) | |
| { | |
| regmap_update_bits(priv->hhi, HHI_GCLK_MPEG2, BIT(25), 0); | |
| writel_relaxed(0, priv->io_base + _REG(VENC_INTCTRL)); | |
| } | |
| void meson_venc_init(struct meson_drm *priv) | |
| { | |
| /* Disable CVBS VDAC */ | |
| if (meson_vpu_is_compatible(priv, VPU_COMPATIBLE_G12A)) { | |
| regmap_write(priv->hhi, HHI_VDAC_CNTL0_G12A, 0); | |
| regmap_write(priv->hhi, HHI_VDAC_CNTL1_G12A, 8); | |
| } else { | |
| regmap_write(priv->hhi, HHI_VDAC_CNTL0, 0); | |
| regmap_write(priv->hhi, HHI_VDAC_CNTL1, 8); | |
| } | |
| /* Power Down Dacs */ | |
| writel_relaxed(0xff, priv->io_base + _REG(VENC_VDAC_SETTING)); | |
| /* Disable HDMI PHY */ | |
| regmap_write(priv->hhi, HHI_HDMI_PHY_CNTL0, 0); | |
| /* Disable HDMI */ | |
| writel_bits_relaxed(VPU_HDMI_ENCI_DATA_TO_HDMI | | |
| VPU_HDMI_ENCP_DATA_TO_HDMI, 0, | |
| priv->io_base + _REG(VPU_HDMI_SETTING)); | |
| /* Disable all encoders */ | |
| writel_relaxed(0, priv->io_base + _REG(ENCI_VIDEO_EN)); | |
| writel_relaxed(0, priv->io_base + _REG(ENCP_VIDEO_EN)); | |
| writel_relaxed(0, priv->io_base + _REG(ENCL_VIDEO_EN)); | |
| /* Disable VSync IRQ */ | |
| meson_venc_disable_vsync(priv); | |
| priv->venc.current_mode = MESON_VENC_MODE_NONE; | |
| } |