[U-Boot] [RFC PATCH 2/3] sunxi: video: Add video driver for H3 SoC
Jernej Skrabec
jernej.skrabec at siol.net
Tue Dec 13 01:36:29 CET 2016
This patch adds support for hdmi output. It is designed in the same
way as video driver for older Allwinner SoCs.
First it checks if monitor is attached. If it is, recommended
timings are read from EDID. After that, DE2, TCON and HDMI are
configured according to this timings.
32MB of RAM is used for framebuffer. This is just enough to support
4K resolution.
SimpleFB is also supported by this driver.
Signed-off-by: Jernej Skrabec <jernej.skrabec at siol.net>
---
arch/arm/include/asm/arch-sunxi/cpu_sun4i.h | 8 +
arch/arm/include/asm/arch-sunxi/display2.h | 377 ++++++++++
board/sunxi/Kconfig | 4 +-
drivers/video/Makefile | 1 +
drivers/video/sunxi_display2.c | 1037 +++++++++++++++++++++++++++
include/configs/sunxi-common.h | 17 +-
scripts/config_whitelist.txt | 1 +
7 files changed, 1438 insertions(+), 7 deletions(-)
create mode 100644 arch/arm/include/asm/arch-sunxi/display2.h
create mode 100644 drivers/video/sunxi_display2.c
diff --git a/arch/arm/include/asm/arch-sunxi/cpu_sun4i.h b/arch/arm/include/asm/arch-sunxi/cpu_sun4i.h
index 7232f6d..9df6212 100644
--- a/arch/arm/include/asm/arch-sunxi/cpu_sun4i.h
+++ b/arch/arm/include/asm/arch-sunxi/cpu_sun4i.h
@@ -18,6 +18,8 @@
#define SUNXI_SRAM_D_BASE 0x00010000 /* 4 kiB */
#define SUNXI_SRAM_B_BASE 0x00020000 /* 64 kiB (secure) */
+#define SUNXI_DE2_BASE 0x01000000
+
#ifdef CONFIG_MACH_SUN8I_A83T
#define SUNXI_CPUCFG_BASE 0x01700000
#endif
@@ -46,7 +48,9 @@
#define SUNXI_USB1_BASE 0x01c14000
#endif
#define SUNXI_SS_BASE 0x01c15000
+#ifndef CONFIG_MACH_SUN8I_H3
#define SUNXI_HDMI_BASE 0x01c16000
+#endif
#define SUNXI_SPI2_BASE 0x01c17000
#define SUNXI_SATA_BASE 0x01c18000
#ifdef CONFIG_SUNXI_GEN_SUN4I
@@ -163,6 +167,10 @@ defined(CONFIG_MACH_SUN50I)
#define SUNXI_MP_BASE 0x01e80000
#define SUNXI_AVG_BASE 0x01ea0000
+#ifdef CONFIG_MACH_SUN8I_H3
+#define SUNXI_HDMI_BASE 0x01ee0000
+#endif
+
#define SUNXI_RTC_BASE 0x01f00000
#define SUNXI_PRCM_BASE 0x01f01400
diff --git a/arch/arm/include/asm/arch-sunxi/display2.h b/arch/arm/include/asm/arch-sunxi/display2.h
new file mode 100644
index 0000000..b1d99d7
--- /dev/null
+++ b/arch/arm/include/asm/arch-sunxi/display2.h
@@ -0,0 +1,377 @@
+/*
+ * Sunxi platform display controller register and constant defines
+ *
+ * (C) Copyright 2016 Jernej Skrabec <jernej.skrabec at siol.net>
+ *
+ * Based on Linux DRM driver defines:
+ * Copyright (C) 2016 Jean-Francois Moine <moinejf at free.fr>
+ * Copyright (c) 2016 Allwinnertech Co., Ltd.
+ *
+ * Based on display.h:
+ * (C) Copyright 2014 Hans de Goede <hdegoede at redhat.com>
+ *
+ * SPDX-License-Identifier: GPL-2.0+
+ */
+
+#ifndef _SUNXI_DISPLAY2_H
+#define _SUNXI_DISPLAY2_H
+
+struct sunxi_lcdc_reg {
+ u32 ctrl; /* 0x00 */
+ u32 int0; /* 0x04 */
+ u32 int1; /* 0x08 */
+ u8 res0[0x04]; /* 0x0c */
+ u32 tcon0_frm_ctrl; /* 0x10 */
+ u32 tcon0_frm_seed[6]; /* 0x14 */
+ u32 tcon0_frm_table[4]; /* 0x2c */
+ u8 res1[4]; /* 0x3c */
+ u32 tcon0_ctrl; /* 0x40 */
+ u32 tcon0_dclk; /* 0x44 */
+ u32 tcon0_timing_active; /* 0x48 */
+ u32 tcon0_timing_h; /* 0x4c */
+ u32 tcon0_timing_v; /* 0x50 */
+ u32 tcon0_timing_sync; /* 0x54 */
+ u32 tcon0_hv_intf; /* 0x58 */
+ u8 res2[0x04]; /* 0x5c */
+ u32 tcon0_cpu_intf; /* 0x60 */
+ u32 tcon0_cpu_wr_dat; /* 0x64 */
+ u32 tcon0_cpu_rd_dat0; /* 0x68 */
+ u32 tcon0_cpu_rd_dat1; /* 0x6c */
+ u32 tcon0_ttl_timing0; /* 0x70 */
+ u32 tcon0_ttl_timing1; /* 0x74 */
+ u32 tcon0_ttl_timing2; /* 0x78 */
+ u32 tcon0_ttl_timing3; /* 0x7c */
+ u32 tcon0_ttl_timing4; /* 0x80 */
+ u32 tcon0_lvds_intf; /* 0x84 */
+ u32 tcon0_io_polarity; /* 0x88 */
+ u32 tcon0_io_tristate; /* 0x8c */
+ u32 tcon1_ctrl; /* 0x90 */
+ u32 tcon1_timing_source; /* 0x94 */
+ u32 tcon1_timing_scale; /* 0x98 */
+ u32 tcon1_timing_out; /* 0x9c */
+ u32 tcon1_timing_h; /* 0xa0 */
+ u32 tcon1_timing_v; /* 0xa4 */
+ u32 tcon1_timing_sync; /* 0xa8 */
+ u8 res3[0x44]; /* 0xac */
+ u32 tcon1_io_polarity; /* 0xf0 */
+ u32 tcon1_io_tristate; /* 0xf4 */
+ u8 res4[0x108]; /* 0xf8 */
+ u32 mux_ctrl; /* 0x200 */
+};
+
+/* internal clock settings */
+struct de_clk {
+ u32 gate_cfg;
+ u32 bus_cfg;
+ u32 rst_cfg;
+ u32 div_cfg;
+ u32 sel_cfg;
+};
+
+/* global control */
+struct de_glb {
+ u32 ctl;
+ u32 status;
+ u32 dbuff;
+ u32 size;
+};
+
+/* alpha blending */
+struct de_bld {
+ u32 fcolor_ctl; /* 00 */
+ struct {
+ u32 fcolor;
+ u32 insize;
+ u32 offset;
+ u32 dum;
+ } attr[4];
+ u32 dum0[15]; /* (end of clear offset) */
+ u32 route; /* 80 */
+ u32 premultiply;
+ u32 bkcolor;
+ u32 output_size;
+ u32 bld_mode[4];
+ u32 dum1[4];
+ u32 ck_ctl; /* b0 */
+ u32 ck_cfg;
+ u32 dum2[2];
+ u32 ck_max[4]; /* c0 */
+ u32 dum3[4];
+ u32 ck_min[4]; /* e0 */
+ u32 dum4[3];
+ u32 out_ctl; /* fc */
+};
+
+/* VI channel */
+struct de_vi {
+ struct {
+ u32 attr;
+ u32 size;
+ u32 coord;
+ u32 pitch[3];
+ u32 top_laddr[3];
+ u32 bot_laddr[3];
+ } cfg[4];
+ u32 fcolor[4]; /* c0 */
+ u32 top_haddr[3]; /* d0 */
+ u32 bot_haddr[3]; /* dc */
+ u32 ovl_size[2]; /* e8 */
+ u32 hori[2]; /* f0 */
+ u32 vert[2]; /* f8 */
+};
+
+struct de_ui {
+ struct {
+ u32 attr;
+ u32 size;
+ u32 coord;
+ u32 pitch;
+ u32 top_laddr;
+ u32 bot_laddr;
+ u32 fcolor;
+ u32 dum;
+ } cfg[4]; /* 00 */
+ u32 top_haddr; /* 80 */
+ u32 bot_haddr;
+ u32 ovl_size; /* 88 */
+};
+
+struct sunxi_dwc_hdmi {
+ u8 reserved0[0x100];
+ u8 ih_fc_stat0;
+ u8 ih_fc_stat1;
+ u8 ih_fc_stat2;
+ u8 ih_as_stat0;
+ u8 ih_phy_stat0;
+ u8 ih_i2cm_stat0;
+ u8 ih_cec_stat0;
+ u8 ih_vp_stat0;
+ u8 ih_i2cmphy_stat0;
+ u8 ih_ahbdmaaud_stat0;
+ u8 reserved1[0x17f-0x109];
+ u8 ih_mute_fc_stat0;
+ u8 ih_mute_fc_stat1;
+ u8 ih_mute_fc_stat2;
+ u8 ih_mute_as_stat0;
+ u8 ih_mute_phy_stat0;
+ u8 ih_mute_i2cm_stat0;
+ u8 ih_mute_cec_stat0;
+ u8 ih_mute_vp_stat0;
+ u8 ih_mute_i2cmphy_stat0;
+ u8 ih_mute_ahbdmaaud_stat0;
+ u8 reserved2[0x1fe - 0x189];
+ u8 ih_mute;
+ u8 tx_invid0;
+ u8 tx_instuffing;
+ u8 tx_gydata0;
+ u8 tx_gydata1;
+ u8 tx_rcrdata0;
+ u8 tx_rcrdata1;
+ u8 tx_bcbdata0;
+ u8 tx_bcbdata1;
+ u8 reserved3[0x7ff-0x207];
+ u8 vp_status;
+ u8 vp_pr_cd;
+ u8 vp_stuff;
+ u8 vp_remap;
+ u8 vp_conf;
+ u8 vp_stat;
+ u8 vp_int;
+ u8 vp_mask;
+ u8 vp_pol;
+ u8 reserved4[0xfff-0x808];
+ u8 fc_invidconf;
+ u8 fc_inhactv0;
+ u8 fc_inhactv1;
+ u8 fc_inhblank0;
+ u8 fc_inhblank1;
+ u8 fc_invactv0;
+ u8 fc_invactv1;
+ u8 fc_invblank;
+ u8 fc_hsyncindelay0;
+ u8 fc_hsyncindelay1;
+ u8 fc_hsyncinwidth0;
+ u8 fc_hsyncinwidth1;
+ u8 fc_vsyncindelay;
+ u8 fc_vsyncinwidth;
+ u8 fc_infreq0;
+ u8 fc_infreq1;
+ u8 fc_infreq2;
+ u8 fc_ctrldur;
+ u8 fc_exctrldur;
+ u8 fc_exctrlspac;
+ u8 fc_ch0pream;
+ u8 fc_ch1pream;
+ u8 fc_ch2pream;
+ u8 fc_aviconf3;
+ u8 fc_gcp;
+ u8 fc_aviconf0;
+ u8 fc_aviconf1;
+ u8 fc_aviconf2;
+ u8 fc_avivid;
+ u8 fc_avietb0;
+ u8 fc_avietb1;
+ u8 fc_avisbb0;
+ u8 fc_avisbb1;
+ u8 fc_avielb0;
+ u8 fc_avielb1;
+ u8 fc_avisrb0;
+ u8 fc_avisrb1;
+ u8 fc_audiconf0;
+ u8 fc_audiconf1;
+ u8 fc_audiconf2;
+ u8 fc_audiconf3;
+ u8 fc_vsdieeeid0;
+ u8 fc_vsdsize;
+ u8 reserved5[0x30ff-0x102a];
+ u8 aud_conf0;
+ u8 aud_conf1;
+ u8 aud_int;
+ u8 aud_conf2;
+ u8 aud_int1;
+ u8 reserved6[0x31ff-0x3104];
+ u8 aud_n1;
+ u8 aud_n2;
+ u8 aud_n3;
+ u8 aud_cts1;
+ u8 aud_cts2;
+ u8 aud_cts3;
+ u8 aud_inputclkfs;
+ u8 reserved7[0x3fff-0x3206];
+ u8 mc_sfrdiv;
+ u8 mc_clkdis;
+ u8 mc_swrstz;
+ u8 mc_opctrl;
+ u8 mc_flowctrl;
+ u8 mc_phyrstz;
+ u8 mc_lockonclock;
+ u8 mc_heacphy_rst;
+ u8 reserved8[0x40ff-0x4007];
+ u8 csc_cfg;
+ u8 csc_scale;
+ struct {
+ u8 msb;
+ u8 lsb;
+ } csc_coef[3][4];
+ u8 reserved9[0x7dff-0x4119];
+ u8 i2cm_slave;
+ u8 i2c_address;
+ u8 i2cm_datao;
+ u8 i2cm_datai;
+ u8 i2cm_operation;
+ u8 i2cm_int;
+ u8 i2cm_ctlint;
+ u8 i2cm_div;
+ u8 i2cm_segaddr;
+ u8 i2cm_softrstz;
+ u8 i2cm_segptr;
+ u8 i2cm_ss_scl_hcnt_1_addr;
+ u8 i2cm_ss_scl_hcnt_0_addr;
+ u8 i2cm_ss_scl_lcnt_1_addr;
+ u8 i2cm_ss_scl_lcnt_0_addr;
+ u8 i2cm_fs_scl_hcnt_1_addr;
+ u8 i2cm_fs_scl_hcnt_0_addr;
+ u8 i2cm_fs_scl_lcnt_1_addr;
+ u8 i2cm_fs_scl_lcnt_0_addr;
+ u8 reserved10[0xffff-0x7e12];
+ u32 phy_pol;
+ u32 phy_reserved11[3];
+ u32 phy_read_en;
+ u32 phy_unscramble;
+ u32 reserved12[2];
+ u32 phy_ctrl;
+ u32 phy_unk1;
+ u32 phy_unk2;
+ u32 phy_pll;
+ u32 phy_clk;
+ u32 phy_unk3;
+ u32 phy_status;
+};
+
+/*
+ * DE register constants.
+ */
+#define SUNXI_DE2_MUX0_BASE (u8 *)(SUNXI_DE2_BASE + 0x100000)
+
+#define SUNXI_DE2_MUX_GLB_REGS 0x00000
+#define SUNXI_DE2_MUX_BLD_REGS 0x01000
+#define SUNXI_DE2_MUX_CHAN_REGS 0x02000
+#define SUNXI_DE2_MUX_CHAN_SZ 0x1000
+#define SUNXI_DE2_MUX_VSU_REGS 0x20000
+#define SUNXI_DE2_MUX_GSU1_REGS 0x30000
+#define SUNXI_DE2_MUX_GSU2_REGS 0x40000
+#define SUNXI_DE2_MUX_GSU3_REGS 0x50000
+#define SUNXI_DE2_MUX_FCE_REGS 0xa0000
+#define SUNXI_DE2_MUX_BWS_REGS 0xa2000
+#define SUNXI_DE2_MUX_LTI_REGS 0xa4000
+#define SUNXI_DE2_MUX_PEAK_REGS 0xa6000
+#define SUNXI_DE2_MUX_ASE_REGS 0xa8000
+#define SUNXI_DE2_MUX_FCC_REGS 0xaa000
+#define SUNXI_DE2_MUX_DCSC_REGS 0xb0000
+
+#define SUNXI_DE2_FORMAT_ARGB_8888 0
+#define SUNXI_DE2_FORMAT_BGRA_8888 3
+#define SUNXI_DE2_FORMAT_XRGB_8888 4
+#define SUNXI_DE2_FORMAT_RGB_888 8
+#define SUNXI_DE2_FORMAT_BGR_888 9
+
+#define SUNXI_DE2_MUX_GLB_CTL_RT_EN (1 << 0)
+
+#define SUNXI_DE2_UI_CFG_ATTR_EN (1 << 0)
+#define SUNXI_DE2_UI_CFG_ATTR_ALPMOD(m) ((m & 3) << 1)
+#define SUNXI_DE2_UI_CFG_ATTR_FMT(f) ((f & 0xf) << 8)
+#define SUNXI_DE2_UI_CFG_ATTR_ALPHA(a) ((a & 0xff) << 24)
+
+#define SUNXI_DE2_WH(w, h) (((h - 1) << 16) | (w - 1))
+
+/*
+ * LCDC register constants.
+ */
+#define SUNXI_LCDC_X(x) (((x) - 1) << 16)
+#define SUNXI_LCDC_Y(y) (((y) - 1) << 0)
+#define SUNXI_LCDC_CTRL_TCON_ENABLE (1 << 31)
+#define SUNXI_LCDC_TCON0_CTRL_ENABLE (1 << 31)
+#define SUNXI_LCDC_TCON1_CTRL_CLK_DELAY(n) (((n) & 0x1f) << 4)
+#define SUNXI_LCDC_TCON1_CTRL_INTERLACE_ENABLE (1 << 20)
+#define SUNXI_LCDC_TCON1_CTRL_ENABLE (1 << 31)
+#define SUNXI_LCDC_TCON1_TIMING_H_BP(n) (((n) - 1) << 0)
+#define SUNXI_LCDC_TCON1_TIMING_H_TOTAL(n) (((n) - 1) << 16)
+#define SUNXI_LCDC_TCON1_TIMING_V_BP(n) (((n) - 1) << 0)
+#define SUNXI_LCDC_TCON1_TIMING_V_TOTAL(n) ((n) << 16)
+
+/*
+ * HDMI register constants.
+ */
+#define HDMI_IH_MUTE_MUTE_WAKEUP_INTERRUPT 0x02
+#define HDMI_IH_MUTE_MUTE_ALL_INTERRUPT 0x01
+
+#define HDMI_TX_INSTUFFING_BDBDATA_STUFFING_EN 0x04
+#define HDMI_TX_INSTUFFING_RCRDATA_STUFFING_EN 0x02
+#define HDMI_TX_INSTUFFING_GYDATA_STUFFING_EN 0x01
+
+#define HDMI_FC_INVIDCONF_DVI_MODE_HDMI 0x08
+#define HDMI_FC_INVIDCONF_DE_IN_POL_ACTIVE_HIGH 0x10
+
+#define HDMI_FC_AVICONF0_ACTIVE_FORMAT 0x40
+#define HDMI_FC_AVICONF0_SCAN_INFO_UNDERSCAN 0x20
+
+#define HDMI_FC_AVICONF2_RGB_QUANT_FULL_RANGE 0x08
+#define HDMI_FC_AVICONF2_IT_CONTENT_VALID 0x80
+
+#define HDMI_MC_CLKDIS_TMDSCLK_DISABLE 0x02
+
+#define HDMI_MC_FLOWCTRL_CSC_BYPASS 0x00
+
+#define HDMI_I2CM_CTLINT_ADDR_NACK_POL 0x80
+#define HDMI_I2CM_CTLINT_ADDR_NACK_MSK 0x40
+#define HDMI_I2CM_CTLINT_ADDR_ARB_POL 0x08
+#define HDMI_I2CM_CTLINT_ADDR_ARB_MSK 0x04
+
+#define HMDI_DDC_CTRL_RESET (1 << 0)
+#define HMDI_DDC_ADDR_SLAVE_ADDR (0x50 << 0)
+#define HMDI_DDC_ADDR_SEG_ADDR (0x30 << 0)
+
+#define SUNXI_HDMI_HPD_DETECT (1 << 19)
+
+
+#endif /* _SUNXI_DISPLAY_H */
diff --git a/board/sunxi/Kconfig b/board/sunxi/Kconfig
index e1d4ab1..1c393eb 100644
--- a/board/sunxi/Kconfig
+++ b/board/sunxi/Kconfig
@@ -462,7 +462,7 @@ config AXP_GPIO
config VIDEO
bool "Enable graphical uboot console on HDMI, LCD or VGA"
- depends on !MACH_SUN8I_A83T && !MACH_SUN8I_H3 && !MACH_SUN9I && !MACH_SUN50I
+ depends on !MACH_SUN8I_A83T && !MACH_SUN9I && !MACH_SUN50I
default y
---help---
Say Y here to add support for using a cfb console on the HDMI, LCD
@@ -471,7 +471,7 @@ config VIDEO
config VIDEO_HDMI
bool "HDMI output support"
- depends on VIDEO && !MACH_SUN8I
+ depends on VIDEO && !MACH_SUN8I_A23 && !MACH_SUN8I_A33
default y
---help---
Say Y here to add support for outputting video over HDMI.
diff --git a/drivers/video/Makefile b/drivers/video/Makefile
index db34904..3097b82 100644
--- a/drivers/video/Makefile
+++ b/drivers/video/Makefile
@@ -52,6 +52,7 @@ obj-$(CONFIG_VIDEO_OMAP3) += omap3_dss.o
obj-$(CONFIG_VIDEO_SANDBOX_SDL) += sandbox_sdl.o
obj-$(CONFIG_VIDEO_SM501) += sm501.o
obj-$(CONFIG_VIDEO_SUNXI) += sunxi_display.o videomodes.o
+obj-$(CONFIG_VIDEO_SUNXI2) += sunxi_display2.o videomodes.o
obj-$(CONFIG_VIDEO_TEGRA20) += tegra.o
obj-$(CONFIG_VIDEO_VCXK) += bus_vcxk.o
obj-$(CONFIG_VIDEO_VESA) += vesa.o
diff --git a/drivers/video/sunxi_display2.c b/drivers/video/sunxi_display2.c
new file mode 100644
index 0000000..db376d9
--- /dev/null
+++ b/drivers/video/sunxi_display2.c
@@ -0,0 +1,1037 @@
+/*
+ * Display driver for sunxi Allwinner SoCs with DE2.
+ *
+ * Copyright (C) 2016 Jernej Skrabec <jernej.skrabec at siol.net>
+ *
+ * Based on sunxi_display.c:
+ * (C) Copyright 2013-2014 Luc Verhaegen <libv at skynet.be>
+ * (C) Copyright 2014-2015 Hans de Goede <hdegoede at redhat.com>
+ *
+ * Based on Linux DRM driver:
+ * Copyright (C) 2016 Jean-Francois Moine <moinejf at free.fr>
+ * Copyright (c) 2016 Allwinnertech Co., Ltd.
+ *
+ * Based on rk_hdmi.c:
+ * Copyright (c) 2015 Google, Inc
+ * Copyright 2014 Rockchip Inc.
+ *
+ * SPDX-License-Identifier: GPL-2.0+
+ */
+
+#include <common.h>
+
+#include <asm/arch/clock.h>
+#include <asm/arch/display2.h>
+#include <asm/global_data.h>
+#include <asm/io.h>
+#include <errno.h>
+#include <fdt_support.h>
+#include <video_fb.h>
+#include "videomodes.h"
+
+DECLARE_GLOBAL_DATA_PTR;
+
+enum sunxi_monitor {
+ sunxi_monitor_none,
+ sunxi_monitor_dvi,
+ sunxi_monitor_hdmi,
+};
+#define SUNXI_MONITOR_LAST sunxi_monitor_hdmi
+
+struct sunxi_display {
+ GraphicDevice graphic_device;
+ enum sunxi_monitor monitor;
+ unsigned int depth;
+ unsigned int fb_addr;
+ unsigned int fb_size;
+} sunxi_display;
+
+#ifdef CONFIG_VIDEO_HDMI
+
+static void sunxi_hdmi_phy_init(void)
+{
+ struct sunxi_dwc_hdmi * const hdmi =
+ (struct sunxi_dwc_hdmi *)SUNXI_HDMI_BASE;
+ unsigned long tmo;
+ u32 tmp;
+
+ /*
+ * HDMI PHY settings are taken as-is from Allwinner BSP code.
+ * There is no documentation.
+ */
+ writel(0, &hdmi->phy_ctrl);
+ setbits_le32(&hdmi->phy_ctrl, BIT(0));
+ udelay(5);
+ setbits_le32(&hdmi->phy_ctrl, BIT(16));
+ setbits_le32(&hdmi->phy_ctrl, BIT(1));
+ udelay(10);
+ setbits_le32(&hdmi->phy_ctrl, BIT(2));
+ udelay(5);
+ setbits_le32(&hdmi->phy_ctrl, BIT(3));
+ udelay(40);
+ setbits_le32(&hdmi->phy_ctrl, BIT(19));
+ udelay(100);
+ setbits_le32(&hdmi->phy_ctrl, BIT(18));
+ setbits_le32(&hdmi->phy_ctrl, 7 << 4);
+
+ /* Note that Allwinner code doesn't fail in case of timeout */
+ tmo = timer_get_us() + 2000;
+ while ((readl(&hdmi->phy_status) & 0x80) == 0) {
+ if (timer_get_us() > tmo) {
+ printf("Warning: HDMI PHY init timeout!\n");
+ break;
+ }
+ }
+
+ setbits_le32(&hdmi->phy_ctrl, 0xf << 8);
+ setbits_le32(&hdmi->phy_ctrl, BIT(7));
+
+ writel(0x39dc5040, &hdmi->phy_pll);
+ writel(0x80084343, &hdmi->phy_clk);
+ udelay(10000);
+ writel(1, &hdmi->phy_unk3);
+ setbits_le32(&hdmi->phy_pll, BIT(25));
+ udelay(100000);
+ tmp = (readl(&hdmi->phy_status) & 0x1f800) >> 11;
+ setbits_le32(&hdmi->phy_pll, BIT(31) | BIT(30));
+ setbits_le32(&hdmi->phy_pll, tmp);
+ writel(0x01FF0F7F, &hdmi->phy_ctrl);
+ writel(0x80639000, &hdmi->phy_unk1);
+ writel(0x0F81C405, &hdmi->phy_unk2);
+
+ /* enable read access to HDMI controller */
+ writel(0x54524545, &hdmi->phy_read_en);
+ /* descramble register offsets */
+ writel(0x42494E47, &hdmi->phy_unscramble);
+}
+
+static void sunxi_hdmi_ctrl_init(void)
+{
+ struct sunxi_dwc_hdmi * const hdmi =
+ (struct sunxi_dwc_hdmi *)SUNXI_HDMI_BASE;
+
+ /* soft reset HDMI controller */
+ writeb(0x00, &hdmi->mc_swrstz);
+
+ udelay(1);
+
+ writeb(HDMI_IH_MUTE_MUTE_WAKEUP_INTERRUPT |
+ HDMI_IH_MUTE_MUTE_ALL_INTERRUPT,
+ &hdmi->ih_mute);
+ writeb(HDMI_I2CM_CTLINT_ADDR_NACK_POL |
+ HDMI_I2CM_CTLINT_ADDR_NACK_MSK |
+ HDMI_I2CM_CTLINT_ADDR_ARB_POL |
+ HDMI_I2CM_CTLINT_ADDR_ARB_MSK,
+ &hdmi->i2cm_ctlint);
+ writeb(0xff & ~HDMI_MC_CLKDIS_TMDSCLK_DISABLE,
+ &hdmi->mc_clkdis);
+}
+
+static int sunxi_hdmi_hpd_detect(int hpd_delay)
+{
+ struct sunxi_ccm_reg * const ccm =
+ (struct sunxi_ccm_reg *)SUNXI_CCM_BASE;
+ struct sunxi_dwc_hdmi * const hdmi =
+ (struct sunxi_dwc_hdmi *)SUNXI_HDMI_BASE;
+ unsigned long tmo = timer_get_us() + hpd_delay * 1000;
+ int status = 0;
+
+ /* Set pll3 to 297 MHz */
+ clock_set_pll3(297000000);
+
+ /* Set hdmi parent to pll3 */
+ clrsetbits_le32(&ccm->hdmi_clk_cfg, CCM_HDMI_CTRL_PLL_MASK,
+ CCM_HDMI_CTRL_PLL3);
+
+ /* Set ahb gating to pass */
+ setbits_le32(&ccm->ahb_reset1_cfg, 1 << AHB_RESET_OFFSET_HDMI);
+ setbits_le32(&ccm->ahb_reset1_cfg, 1 << AHB_RESET_OFFSET_HDMI2);
+ setbits_le32(&ccm->ahb_gate1, 1 << AHB_GATE_OFFSET_HDMI);
+ setbits_le32(&ccm->hdmi_slow_clk_cfg, CCM_HDMI_SLOW_CTRL_DDC_GATE);
+
+ /* Clock on */
+ setbits_le32(&ccm->hdmi_clk_cfg, CCM_HDMI_CTRL_GATE);
+
+ sunxi_hdmi_phy_init();
+ sunxi_hdmi_ctrl_init();
+
+ while (timer_get_us() < tmo) {
+ if (readl(&hdmi->phy_status) & SUNXI_HDMI_HPD_DETECT) {
+ status = 1;
+ break;
+ }
+ }
+
+ return status;
+}
+
+static void sunxi_hdmi_shutdown(void)
+{
+ struct sunxi_ccm_reg * const ccm =
+ (struct sunxi_ccm_reg *)SUNXI_CCM_BASE;
+ struct sunxi_dwc_hdmi * const hdmi =
+ (struct sunxi_dwc_hdmi *)SUNXI_HDMI_BASE;
+
+ writel(0, &hdmi->phy_ctrl);
+ clrbits_le32(&ccm->hdmi_clk_cfg, CCM_HDMI_CTRL_GATE);
+ clrbits_le32(&ccm->hdmi_slow_clk_cfg, CCM_HDMI_SLOW_CTRL_DDC_GATE);
+ clrbits_le32(&ccm->ahb_gate1, 1 << AHB_GATE_OFFSET_HDMI);
+ clrbits_le32(&ccm->ahb_reset1_cfg, 1 << AHB_RESET_OFFSET_HDMI);
+ clrbits_le32(&ccm->ahb_reset1_cfg, 1 << AHB_RESET_OFFSET_HDMI2);
+ clock_set_pll3(0);
+}
+
+static int sunxi_hdmi_ddc_wait_i2c_done(int msec)
+{
+ struct sunxi_dwc_hdmi * const hdmi =
+ (struct sunxi_dwc_hdmi *)SUNXI_HDMI_BASE;
+ u32 val;
+ ulong start;
+
+ start = get_timer(0);
+ do {
+ val = readb(&hdmi->ih_i2cm_stat0);
+ writeb(val, &hdmi->ih_i2cm_stat0);
+
+ if (val & 0x2)
+ return 0;
+ if (val & 0x1)
+ return -EIO;
+
+ udelay(100);
+ } while (get_timer(start) < msec);
+
+ return 1;
+}
+
+static int sunxi_hdmi_ddc_read(int block, u8 *buf)
+{
+ struct sunxi_dwc_hdmi * const hdmi =
+ (struct sunxi_dwc_hdmi *)SUNXI_HDMI_BASE;
+ int shift = (block % 2) * 0x80;
+ int trytime = 5;
+ int edid_read_err = 0;
+ u32 op = (block == 0) ? 1 : 2;
+ int n;
+
+ writeb(block >> 1, &hdmi->i2cm_segptr);
+
+ while (trytime--) {
+ edid_read_err = 0;
+
+ for (n = 0; n < 128; n++) {
+ writeb(shift + n, &hdmi->i2c_address);
+ writeb(op, &hdmi->i2cm_operation);
+
+ if (sunxi_hdmi_ddc_wait_i2c_done(10)) {
+ edid_read_err = 1;
+ break;
+ }
+
+ *buf++ = readb(&hdmi->i2cm_datai);
+ }
+
+ if (!edid_read_err)
+ break;
+ }
+
+ return edid_read_err;
+}
+
+static int sunxi_hdmi_edid_get_block(int block, u8 *buf)
+{
+ int r, retries = 2;
+
+ do {
+ r = sunxi_hdmi_ddc_read(block, buf);
+ if (r)
+ continue;
+ r = edid_check_checksum(buf);
+ if (r) {
+ printf("EDID block %d: checksum error%s\n",
+ block, retries ? ", retrying" : "");
+ }
+ } while (r && retries--);
+
+ return r;
+}
+
+static int sunxi_hdmi_edid_get_mode(struct ctfb_res_modes *mode)
+{
+ struct sunxi_dwc_hdmi * const hdmi =
+ (struct sunxi_dwc_hdmi *)SUNXI_HDMI_BASE;
+ struct edid1_info edid1;
+ struct edid_cea861_info cea681[4];
+ struct edid_detailed_timing *t =
+ (struct edid_detailed_timing *)edid1.monitor_details.timing;
+ int i, r, ext_blocks = 0;
+
+ /* Reset i2c controller */
+ writeb(0, &hdmi->i2cm_softrstz);
+
+ writeb(0x05, &hdmi->i2cm_div);
+ writeb(0x08, &hdmi->i2cm_int);
+
+ /* set DDC timing*/
+ writeb(0xd8, &hdmi->i2cm_ss_scl_hcnt_0_addr);
+ writeb(0xfe, &hdmi->i2cm_ss_scl_lcnt_0_addr);
+
+ writeb(HMDI_DDC_ADDR_SLAVE_ADDR, &hdmi->i2cm_slave);
+ writeb(HMDI_DDC_ADDR_SEG_ADDR, &hdmi->i2cm_segaddr);
+
+ r = sunxi_hdmi_edid_get_block(0, (u8 *)&edid1);
+ if (r == 0) {
+ r = edid_check_info(&edid1);
+ if (r) {
+ printf("EDID: invalid EDID data\n");
+ r = -EINVAL;
+ }
+ }
+ if (r == 0) {
+ ext_blocks = edid1.extension_flag;
+ if (ext_blocks > 4)
+ ext_blocks = 4;
+ for (i = 0; i < ext_blocks; i++) {
+ if (sunxi_hdmi_edid_get_block(1 + i,
+ (u8 *)&cea681[i]) != 0) {
+ ext_blocks = i;
+ break;
+ }
+ }
+ }
+
+ if (r)
+ return r;
+
+ /* We want version 1.3 or 1.2 with detailed timing info */
+ if (edid1.version != 1 || (edid1.revision < 3 &&
+ !EDID1_INFO_FEATURE_PREFERRED_TIMING_MODE(edid1))) {
+ printf("EDID: unsupported version %d.%d\n",
+ edid1.version, edid1.revision);
+ return -EINVAL;
+ }
+
+ /* Take the first usable detailed timing */
+ for (i = 0; i < 4; i++, t++) {
+ r = video_edid_dtd_to_ctfb_res_modes(t, mode);
+ if (r == 0)
+ break;
+ }
+ if (i == 4) {
+ printf("EDID: no usable detailed timing found\n");
+ return -ENOENT;
+ }
+
+ /* Check for basic audio support, if found enable hdmi output */
+ sunxi_display.monitor = sunxi_monitor_dvi;
+ for (i = 0; i < ext_blocks; i++) {
+ if (cea681[i].extension_tag != EDID_CEA861_EXTENSION_TAG ||
+ cea681[i].revision < 2)
+ continue;
+
+ if (EDID_CEA861_SUPPORTS_BASIC_AUDIO(cea681[i]))
+ sunxi_display.monitor = sunxi_monitor_hdmi;
+ }
+
+ return 0;
+}
+
+#endif /* CONFIG_VIDEO_HDMI */
+
+/*
+ * This is the entity that mixes and matches the different layers and inputs.
+ * Allwinner calls it display engine, but here is called composer.
+ */
+static void sunxi_composer_init(void)
+{
+ struct sunxi_ccm_reg * const ccm =
+ (struct sunxi_ccm_reg *)SUNXI_CCM_BASE;
+
+ clock_set_pll10(432000000);
+
+ /* Set DE parent to pll10 */
+ clrsetbits_le32(&ccm->de_clk_cfg, CCM_DE2_CTRL_PLL_MASK,
+ CCM_DE2_CTRL_PLL10);
+
+ /* Set ahb gating to pass */
+ setbits_le32(&ccm->ahb_reset1_cfg, 1 << AHB_RESET_OFFSET_DE);
+ setbits_le32(&ccm->ahb_gate1, 1 << AHB_GATE_OFFSET_DE);
+
+ /* Clock on */
+ setbits_le32(&ccm->de_clk_cfg, CCM_DE2_CTRL_GATE);
+}
+
+static void sunxi_composer_mode_set(const struct ctfb_res_modes *mode,
+ unsigned int address)
+{
+ struct de_clk * const de_clk_regs =
+ (struct de_clk *)(SUNXI_DE2_BASE);
+ struct de_glb * const de_glb_regs =
+ (struct de_glb *)(SUNXI_DE2_MUX0_BASE +
+ SUNXI_DE2_MUX_GLB_REGS);
+ struct de_bld * const de_bld_regs =
+ (struct de_bld *)(SUNXI_DE2_MUX0_BASE +
+ SUNXI_DE2_MUX_BLD_REGS);
+ struct de_ui * const de_ui_regs =
+ (struct de_ui *)(SUNXI_DE2_MUX0_BASE +
+ SUNXI_DE2_MUX_CHAN_REGS +
+ SUNXI_DE2_MUX_CHAN_SZ * 1);
+ u32 size = SUNXI_DE2_WH(mode->xres, mode->yres);
+ int channel, i;
+ u32 data;
+
+ /* enable clock */
+ setbits_le32(&de_clk_regs->rst_cfg, 1);
+ setbits_le32(&de_clk_regs->gate_cfg, 1);
+ setbits_le32(&de_clk_regs->bus_cfg, 1);
+
+ clrbits_le32(&de_clk_regs->sel_cfg, 1);
+
+ writel(SUNXI_DE2_MUX_GLB_CTL_RT_EN, &de_glb_regs->ctl);
+ writel(0, &de_glb_regs->status);
+ writel(1, &de_glb_regs->dbuff);
+ writel(size, &de_glb_regs->size);
+
+ for (channel = 0; channel < 4; channel++) {
+ void *chan = SUNXI_DE2_MUX0_BASE + SUNXI_DE2_MUX_CHAN_REGS +
+ SUNXI_DE2_MUX_CHAN_SZ * channel;
+ memset(chan, 0, channel == 0 ?
+ sizeof(struct de_vi) : sizeof(struct de_ui));
+ }
+ memset(de_bld_regs, 0, sizeof(struct de_bld));
+
+ writel(0x00000101, &de_bld_regs->fcolor_ctl);
+
+ writel(1, &de_bld_regs->route);
+
+ writel(0, &de_bld_regs->premultiply);
+ writel(0xff000000, &de_bld_regs->bkcolor);
+
+ writel(0x03010301, &de_bld_regs->bld_mode[0]);
+ writel(0x03010301, &de_bld_regs->bld_mode[1]);
+
+ writel(size, &de_bld_regs->output_size);
+ writel(mode->vmode & FB_VMODE_INTERLACED ? 2 : 0,
+ &de_bld_regs->out_ctl);
+ writel(0, &de_bld_regs->ck_ctl);
+
+ for (i = 0; i < 4; i++) {
+ writel(0xff000000, &de_bld_regs->attr[i].fcolor);
+ writel(size, &de_bld_regs->attr[i].insize);
+ }
+
+ /* Disable all other units */
+ writel(0, SUNXI_DE2_MUX0_BASE + SUNXI_DE2_MUX_VSU_REGS);
+ writel(0, SUNXI_DE2_MUX0_BASE + SUNXI_DE2_MUX_GSU1_REGS);
+ writel(0, SUNXI_DE2_MUX0_BASE + SUNXI_DE2_MUX_GSU2_REGS);
+ writel(0, SUNXI_DE2_MUX0_BASE + SUNXI_DE2_MUX_GSU3_REGS);
+ writel(0, SUNXI_DE2_MUX0_BASE + SUNXI_DE2_MUX_FCE_REGS);
+ writel(0, SUNXI_DE2_MUX0_BASE + SUNXI_DE2_MUX_BWS_REGS);
+ writel(0, SUNXI_DE2_MUX0_BASE + SUNXI_DE2_MUX_LTI_REGS);
+ writel(0, SUNXI_DE2_MUX0_BASE + SUNXI_DE2_MUX_PEAK_REGS);
+ writel(0, SUNXI_DE2_MUX0_BASE + SUNXI_DE2_MUX_ASE_REGS);
+ writel(0, SUNXI_DE2_MUX0_BASE + SUNXI_DE2_MUX_FCC_REGS);
+ writel(0, SUNXI_DE2_MUX0_BASE + SUNXI_DE2_MUX_DCSC_REGS);
+
+ data = SUNXI_DE2_UI_CFG_ATTR_EN |
+ SUNXI_DE2_UI_CFG_ATTR_FMT(SUNXI_DE2_FORMAT_XRGB_8888) |
+ SUNXI_DE2_UI_CFG_ATTR_ALPMOD(1) |
+ SUNXI_DE2_UI_CFG_ATTR_ALPHA(0xff);
+ writel(data, &de_ui_regs->cfg[0].attr);
+ writel(size, &de_ui_regs->cfg[0].size);
+ writel(0, &de_ui_regs->cfg[0].coord);
+ writel(4 * mode->xres, &de_ui_regs->cfg[0].pitch);
+ writel(address, &de_ui_regs->cfg[0].top_laddr);
+ writel(size, &de_ui_regs->ovl_size);
+}
+
+static void sunxi_composer_enable(void)
+{
+ struct de_glb * const de_glb_regs =
+ (struct de_glb *)(SUNXI_DE2_MUX0_BASE +
+ SUNXI_DE2_MUX_GLB_REGS);
+
+ writel(1, &de_glb_regs->dbuff);
+}
+
+/*
+ * LCDC, what allwinner calls a CRTC, so timing controller and serializer.
+ */
+static void sunxi_lcdc_pll_set(int dotclock, int *clk_div)
+{
+ struct sunxi_ccm_reg * const ccm =
+ (struct sunxi_ccm_reg *)SUNXI_CCM_BASE;
+ int value, n, m, x = 0, diff;
+ int best_n = 0, best_m = 0, best_diff = 0x0FFFFFFF;
+
+ /*
+ * Due to unknown registers in HDMI PHY, we know correct settings
+ * only for following four PHY dividers. Select one based on
+ * clock speed.
+ */
+ if (dotclock <= 27000)
+ x = 11;
+ else if (dotclock <= 74250)
+ x = 4;
+ else if (dotclock <= 148500)
+ x = 2;
+ else
+ x = 1;
+
+ /*
+ * Find the lowest divider resulting in a matching clock. If there
+ * is no match, pick the closest lower clock, as monitors tend to
+ * not sync to higher frequencies.
+ */
+ for (m = 1; m <= 16; m++) {
+ n = (m * x * dotclock) / 24000;
+
+ if ((n >= 1) && (n <= 128)) {
+ value = (24000 * n) / m / x;
+ diff = dotclock - value;
+ if (diff < best_diff) {
+ best_diff = diff;
+ best_m = m;
+ best_n = n;
+ }
+ }
+ }
+
+ clock_set_pll3_factors(best_m, best_n);
+ debug("dotclock: %dkHz = %dkHz: (24MHz * %d) / %d / %d\n",
+ dotclock, (clock_get_pll3() / 1000) / x,
+ best_n, best_m, x);
+
+ writel(CCM_TCON0_CTRL_GATE | CCM_TCON0_CTRL_M(x),
+ &ccm->tcon0_clk_cfg);
+
+ *clk_div = x;
+}
+
+static void sunxi_lcdc_init(void)
+{
+ struct sunxi_ccm_reg * const ccm =
+ (struct sunxi_ccm_reg *)SUNXI_CCM_BASE;
+ struct sunxi_lcdc_reg * const lcdc =
+ (struct sunxi_lcdc_reg *)SUNXI_LCD0_BASE;
+
+ /* Reset off */
+ setbits_le32(&ccm->ahb_reset1_cfg, 1 << AHB_RESET_OFFSET_TCON0);
+
+ /* Clock on */
+ setbits_le32(&ccm->ahb_gate1, 1 << AHB_GATE_OFFSET_TCON0);
+ setbits_le32(&ccm->tcon0_clk_cfg, CCM_TCON0_CTRL_GATE);
+
+ /* Init lcdc */
+ writel(0, &lcdc->ctrl); /* Disable tcon */
+ writel(0, &lcdc->int0); /* Disable all interrupts */
+
+ /* Set all io lines to tristate */
+ writel(0x0fffffff, &lcdc->tcon1_io_tristate);
+}
+
+static void sunxi_lcdc_enable(void)
+{
+ struct sunxi_lcdc_reg * const lcdc =
+ (struct sunxi_lcdc_reg *)SUNXI_LCD0_BASE;
+
+ setbits_le32(&lcdc->ctrl, SUNXI_LCDC_CTRL_TCON_ENABLE);
+}
+
+static int sunxi_lcdc_get_clk_delay(const struct ctfb_res_modes *mode)
+{
+ int delay;
+
+ delay = mode->lower_margin + mode->vsync_len + mode->upper_margin;
+ if (mode->vmode == FB_VMODE_INTERLACED)
+ delay /= 2;
+ delay -= 2;
+
+ return (delay > 31) ? 31 : delay;
+}
+
+#if defined CONFIG_VIDEO_HDMI
+static void sunxi_lcdc_tcon1_mode_set(const struct ctfb_res_modes *mode,
+ int *clk_div)
+{
+ struct sunxi_lcdc_reg * const lcdc =
+ (struct sunxi_lcdc_reg *)SUNXI_LCD0_BASE;
+ int bp, clk_delay, total, yres;
+
+ clk_delay = sunxi_lcdc_get_clk_delay(mode);
+ writel(SUNXI_LCDC_TCON1_CTRL_ENABLE |
+ ((mode->vmode == FB_VMODE_INTERLACED) ?
+ SUNXI_LCDC_TCON1_CTRL_INTERLACE_ENABLE : 0) |
+ SUNXI_LCDC_TCON1_CTRL_CLK_DELAY(clk_delay), &lcdc->tcon1_ctrl);
+
+ yres = mode->yres;
+ if (mode->vmode == FB_VMODE_INTERLACED)
+ yres /= 2;
+ writel(SUNXI_LCDC_X(mode->xres) | SUNXI_LCDC_Y(yres),
+ &lcdc->tcon1_timing_source);
+ writel(SUNXI_LCDC_X(mode->xres) | SUNXI_LCDC_Y(yres),
+ &lcdc->tcon1_timing_scale);
+ writel(SUNXI_LCDC_X(mode->xres) | SUNXI_LCDC_Y(yres),
+ &lcdc->tcon1_timing_out);
+
+ bp = mode->hsync_len + mode->left_margin;
+ total = mode->xres + mode->right_margin + bp;
+ writel(SUNXI_LCDC_TCON1_TIMING_H_TOTAL(total) |
+ SUNXI_LCDC_TCON1_TIMING_H_BP(bp), &lcdc->tcon1_timing_h);
+
+ bp = mode->vsync_len + mode->upper_margin;
+ total = mode->yres + mode->lower_margin + bp;
+ if (mode->vmode == FB_VMODE_NONINTERLACED)
+ total *= 2;
+ writel(SUNXI_LCDC_TCON1_TIMING_V_TOTAL(total) |
+ SUNXI_LCDC_TCON1_TIMING_V_BP(bp), &lcdc->tcon1_timing_v);
+
+ writel(SUNXI_LCDC_X(mode->hsync_len) | SUNXI_LCDC_Y(mode->vsync_len),
+ &lcdc->tcon1_timing_sync);
+
+ sunxi_lcdc_pll_set(mode->pixclock_khz, clk_div);
+}
+#endif /* CONFIG_VIDEO_HDMI */
+
+#ifdef CONFIG_VIDEO_HDMI
+
+static void sunxi_hdmi_setup_info_frames(const struct ctfb_res_modes *mode)
+{
+ struct sunxi_dwc_hdmi * const hdmi =
+ (struct sunxi_dwc_hdmi *)SUNXI_HDMI_BASE;
+ u8 tmp;
+
+ if (mode->pixclock_khz <= 27000)
+ tmp = 0x40; /* SD-modes, ITU601 colorspace */
+ else
+ tmp = 0x80; /* HD-modes, ITU709 colorspace */
+
+ if (mode->xres * 100 / mode->yres < 156)
+ tmp |= 0x18; /* 4 : 3 */
+ else
+ tmp |= 0x28; /* 16 : 9 */
+
+ setbits_8(&hdmi->fc_invidconf,
+ HDMI_FC_INVIDCONF_DVI_MODE_HDMI);
+ writeb(HDMI_FC_AVICONF0_ACTIVE_FORMAT |
+ HDMI_FC_AVICONF0_SCAN_INFO_UNDERSCAN,
+ &hdmi->fc_aviconf0);
+ writeb(tmp, &hdmi->fc_aviconf1);
+ writeb(HDMI_FC_AVICONF2_RGB_QUANT_FULL_RANGE |
+ HDMI_FC_AVICONF2_IT_CONTENT_VALID,
+ &hdmi->fc_aviconf2);
+}
+
+static void sunxi_hdmi_phy_set(u32 divider)
+{
+ struct sunxi_dwc_hdmi * const hdmi =
+ (struct sunxi_dwc_hdmi *)SUNXI_HDMI_BASE;
+ u32 tmp;
+
+ /*
+ * Unfortunatelly, we don't know much about those magic
+ * numbers. They are taken from Allwinner BSP driver.
+ */
+ switch (divider) {
+ case 1:
+ writel(0x30dc5fc0, &hdmi->phy_pll);
+ writel(0x800863C0, &hdmi->phy_clk);
+ mdelay(10);
+ writel(0x00000001, &hdmi->phy_unk3);
+ setbits_le32(&hdmi->phy_pll, BIT(25));
+ mdelay(200);
+ tmp = (readl(&hdmi->phy_status) & 0x1f800) >> 11;
+ setbits_le32(&hdmi->phy_pll, BIT(31) | BIT(30));
+ if (tmp < 0x3d)
+ setbits_le32(&hdmi->phy_pll, tmp + 2);
+ else
+ setbits_le32(&hdmi->phy_pll, 0x3f);
+ mdelay(100);
+ writel(0x01FFFF7F, &hdmi->phy_ctrl);
+ writel(0x8063b000, &hdmi->phy_unk1);
+ writel(0x0F8246B5, &hdmi->phy_unk2);
+ break;
+ case 2:
+ writel(0x39dc5040, &hdmi->phy_pll);
+ writel(0x80084381, &hdmi->phy_clk);
+ mdelay(10);
+ writel(0x00000001, &hdmi->phy_unk3);
+ setbits_le32(&hdmi->phy_pll, BIT(25));
+ mdelay(100);
+ tmp = (readl(&hdmi->phy_status) & 0x1f800) >> 11;
+ setbits_le32(&hdmi->phy_pll, BIT(31) | BIT(30));
+ setbits_le32(&hdmi->phy_pll, tmp);
+ writel(0x01FFFF7F, &hdmi->phy_ctrl);
+ writel(0x8063a800, &hdmi->phy_unk1);
+ writel(0x0F81C485, &hdmi->phy_unk2);
+ break;
+ case 4:
+ writel(0x39dc5040, &hdmi->phy_pll);
+ writel(0x80084343, &hdmi->phy_clk);
+ mdelay(10);
+ writel(0x00000001, &hdmi->phy_unk3);
+ setbits_le32(&hdmi->phy_pll, BIT(25));
+ mdelay(100);
+ tmp = (readl(&hdmi->phy_status) & 0x1f800) >> 11;
+ setbits_le32(&hdmi->phy_pll, BIT(31) | BIT(30));
+ setbits_le32(&hdmi->phy_pll, tmp);
+ writel(0x01FFFF7F, &hdmi->phy_ctrl);
+ writel(0x8063b000, &hdmi->phy_unk1);
+ writel(0x0F81C405, &hdmi->phy_unk2);
+ break;
+ case 11:
+ writel(0x39dc5040, &hdmi->phy_pll);
+ writel(0x8008430a, &hdmi->phy_clk);
+ mdelay(10);
+ writel(0x00000001, &hdmi->phy_unk3);
+ setbits_le32(&hdmi->phy_pll, BIT(25));
+ mdelay(100);
+ tmp = (readl(&hdmi->phy_status) & 0x1f800) >> 11;
+ setbits_le32(&hdmi->phy_pll, BIT(31) | BIT(30));
+ setbits_le32(&hdmi->phy_pll, tmp);
+ writel(0x01FFFF7F, &hdmi->phy_ctrl);
+ writel(0x8063b000, &hdmi->phy_unk1);
+ writel(0x0F81C405, &hdmi->phy_unk2);
+ break;
+ }
+}
+
+static void sunxi_hdmi_mode_set(const struct ctfb_res_modes *mode,
+ int clk_div)
+{
+ struct sunxi_dwc_hdmi * const hdmi =
+ (struct sunxi_dwc_hdmi *)SUNXI_HDMI_BASE;
+ u8 invidconf, v_blanking;
+ u32 h_blanking;
+
+ sunxi_hdmi_phy_set(clk_div);
+
+ invidconf = 0;
+ if (mode->vmode & FB_VMODE_INTERLACED)
+ invidconf |= 0x01;
+ if (mode->sync & FB_SYNC_HOR_HIGH_ACT)
+ invidconf |= 0x20;
+ if (mode->sync & FB_SYNC_VERT_HIGH_ACT)
+ invidconf |= 0x40;
+
+ h_blanking = mode->left_margin + mode->right_margin + mode->hsync_len;
+ v_blanking = mode->upper_margin + mode->lower_margin + mode->vsync_len;
+
+ writeb(invidconf |
+ HDMI_FC_INVIDCONF_DE_IN_POL_ACTIVE_HIGH,
+ &hdmi->fc_invidconf);
+ if (invidconf < 96)
+ setbits_le32(&hdmi->phy_pol, 0x300);
+
+ writeb(mode->xres, &hdmi->fc_inhactv0);
+ writeb(mode->xres >> 8, &hdmi->fc_inhactv1);
+ writeb(h_blanking, &hdmi->fc_inhblank0);
+ writeb(h_blanking >> 8, &hdmi->fc_inhblank1);
+ writeb(mode->yres, &hdmi->fc_invactv0);
+ writeb(mode->yres >> 8, &hdmi->fc_invactv1);
+ writeb(v_blanking, &hdmi->fc_invblank);
+ writeb(mode->right_margin, &hdmi->fc_hsyncindelay0);
+ writeb(mode->right_margin >> 8, &hdmi->fc_hsyncindelay1);
+ writeb(mode->hsync_len, &hdmi->fc_hsyncinwidth0);
+ writeb(mode->hsync_len >> 8, &hdmi->fc_hsyncinwidth1);
+ writeb(mode->lower_margin, &hdmi->fc_vsyncindelay);
+ writeb(mode->vsync_len, &hdmi->fc_vsyncinwidth);
+
+ /* control period minimum duration */
+ writeb(0x0c, &hdmi->fc_ctrldur);
+ writeb(0x20, &hdmi->fc_exctrldur);
+ writeb(0x01, &hdmi->fc_exctrlspac);
+
+ /* set to fill tmds data channels */
+ writeb(0x0b, &hdmi->fc_ch0pream);
+ writeb(0x16, &hdmi->fc_ch1pream);
+ writeb(0x21, &hdmi->fc_ch2pream);
+
+ writeb(0x40, &hdmi->vp_pr_cd);
+ writeb(0x07, &hdmi->vp_stuff);
+ writeb(0x00, &hdmi->vp_remap);
+ writeb(0x47, &hdmi->vp_conf);
+
+ writeb(0x01, &hdmi->tx_invid0);
+
+ /* enable tx stuffing: when de is inactive, fix the output data to 0 */
+ writeb(HDMI_TX_INSTUFFING_BDBDATA_STUFFING_EN |
+ HDMI_TX_INSTUFFING_RCRDATA_STUFFING_EN |
+ HDMI_TX_INSTUFFING_GYDATA_STUFFING_EN,
+ &hdmi->tx_instuffing);
+ writeb(0x00, &hdmi->tx_gydata0);
+ writeb(0x00, &hdmi->tx_gydata1);
+ writeb(0x00, &hdmi->tx_rcrdata0);
+ writeb(0x00, &hdmi->tx_rcrdata1);
+ writeb(0x00, &hdmi->tx_bcbdata0);
+ writeb(0x00, &hdmi->tx_bcbdata1);
+
+ if (sunxi_display.monitor == sunxi_monitor_hdmi)
+ sunxi_hdmi_setup_info_frames(mode);
+
+ writeb(HDMI_MC_FLOWCTRL_CSC_BYPASS, &hdmi->mc_flowctrl);
+ /* enable audio, TMDS and pixel clock */
+ writeb(0x74, &hdmi->mc_clkdis);
+
+ /*
+ * This is last hdmi access before boot,
+ * so scramble addresses again. Othwerwise
+ * BSP or current DRM driver won't work.
+ * Dummy read is needed or otherwise last
+ * write doesn't get written correctly.
+ */
+ (void)readb(&hdmi->reserved0[0]);
+ writel(0, &hdmi->phy_unscramble);
+}
+
+static void sunxi_hdmi_enable(void)
+{
+ struct sunxi_dwc_hdmi * const hdmi =
+ (struct sunxi_dwc_hdmi *)SUNXI_HDMI_BASE;
+
+ setbits_le32(&hdmi->phy_ctrl, 0xf << 12);
+ printf("hdmi enabled\n");
+}
+
+#endif /* CONFIG_VIDEO_HDMI */
+
+static void sunxi_engines_init(void)
+{
+ sunxi_composer_init();
+ sunxi_lcdc_init();
+}
+
+static void sunxi_mode_set(const struct ctfb_res_modes *mode,
+ unsigned int address)
+{
+ int __maybe_unused clk_div;
+
+ switch (sunxi_display.monitor) {
+ case sunxi_monitor_none:
+ break;
+ case sunxi_monitor_dvi:
+ case sunxi_monitor_hdmi:
+#ifdef CONFIG_VIDEO_HDMI
+ sunxi_composer_mode_set(mode, address);
+ sunxi_lcdc_tcon1_mode_set(mode, &clk_div);
+ sunxi_hdmi_mode_set(mode, clk_div);
+ sunxi_composer_enable();
+ sunxi_lcdc_enable();
+ sunxi_hdmi_enable();
+#endif
+ break;
+ }
+}
+
+static const char *sunxi_get_mon_desc(enum sunxi_monitor monitor)
+{
+ switch (monitor) {
+ case sunxi_monitor_none: return "none";
+ case sunxi_monitor_dvi: return "dvi";
+ case sunxi_monitor_hdmi: return "hdmi";
+ }
+ return NULL; /* never reached */
+}
+
+ulong board_get_usable_ram_top(ulong total_size)
+{
+ return gd->ram_top - CONFIG_SUNXI_MAX_FB_SIZE;
+}
+
+static bool sunxi_has_hdmi(void)
+{
+#ifdef CONFIG_VIDEO_HDMI
+ return true;
+#else
+ return false;
+#endif
+}
+
+static enum sunxi_monitor sunxi_get_default_mon(bool allow_hdmi)
+{
+ if (allow_hdmi && sunxi_has_hdmi())
+ return sunxi_monitor_dvi;
+ else
+ return sunxi_monitor_none;
+}
+
+void *video_hw_init(void)
+{
+ static GraphicDevice *graphic_device = &sunxi_display.graphic_device;
+ const struct ctfb_res_modes *mode;
+ struct ctfb_res_modes custom;
+ const char *options;
+#ifdef CONFIG_VIDEO_HDMI
+ int ret, hpd, hpd_delay, edid;
+#endif
+ int i, overscan_offset, overscan_x, overscan_y;
+ unsigned int fb_dma_addr;
+ char mon[16];
+
+ memset(&sunxi_display, 0, sizeof(struct sunxi_display));
+
+ video_get_ctfb_res_modes(RES_MODE_1024x768, 24, &mode,
+ &sunxi_display.depth, &options);
+#ifdef CONFIG_VIDEO_HDMI
+ hpd = video_get_option_int(options, "hpd", 1);
+ hpd_delay = video_get_option_int(options, "hpd_delay", 500);
+ edid = video_get_option_int(options, "edid", 1);
+#endif
+ overscan_x = video_get_option_int(options, "overscan_x", -1);
+ overscan_y = video_get_option_int(options, "overscan_y", -1);
+ sunxi_display.monitor = sunxi_get_default_mon(true);
+ video_get_option_string(options, "monitor", mon, sizeof(mon),
+ sunxi_get_mon_desc(sunxi_display.monitor));
+ for (i = 0; i <= SUNXI_MONITOR_LAST; i++) {
+ if (strcmp(mon, sunxi_get_mon_desc(i)) == 0) {
+ sunxi_display.monitor = i;
+ break;
+ }
+ }
+ if (i > SUNXI_MONITOR_LAST)
+ printf("Unknown monitor: '%s', falling back to '%s'\n",
+ mon, sunxi_get_mon_desc(sunxi_display.monitor));
+
+#ifdef CONFIG_VIDEO_HDMI
+ /* If HDMI/DVI is selected do HPD & EDID, and handle fallback */
+ if (sunxi_display.monitor == sunxi_monitor_dvi ||
+ sunxi_display.monitor == sunxi_monitor_hdmi) {
+ /* Always call hdp_detect, as it also enables clocks, etc. */
+ ret = sunxi_hdmi_hpd_detect(hpd_delay);
+ if (ret) {
+ printf("HDMI connected: ");
+ if (edid && sunxi_hdmi_edid_get_mode(&custom) == 0)
+ mode = &custom;
+ } else if (hpd) {
+ sunxi_hdmi_shutdown();
+ sunxi_display.monitor = sunxi_get_default_mon(false);
+ } /* else continue with hdmi/dvi without a cable connected */
+ }
+#endif
+
+ switch (sunxi_display.monitor) {
+ case sunxi_monitor_none:
+ return NULL;
+ case sunxi_monitor_dvi:
+ case sunxi_monitor_hdmi:
+ if (!sunxi_has_hdmi()) {
+ printf("HDMI/DVI not supported on this board\n");
+ sunxi_display.monitor = sunxi_monitor_none;
+ return NULL;
+ }
+ break;
+ }
+
+ if (overscan_x == -1)
+ overscan_x = 0;
+ if (overscan_y == -1)
+ overscan_y = 0;
+
+ sunxi_display.fb_size =
+ (mode->xres * mode->yres * 4 + 0xfff) & ~0xfff;
+ overscan_offset = (overscan_y * mode->xres + overscan_x) * 4;
+ /* We want to keep the fb_base for simplefb page aligned, where as
+ * the sunxi dma engines will happily accept an unaligned address. */
+ if (overscan_offset)
+ sunxi_display.fb_size += 0x1000;
+
+ if (sunxi_display.fb_size > CONFIG_SUNXI_MAX_FB_SIZE) {
+ printf("Error need %dkB for fb, but only %dkB is reserved\n",
+ sunxi_display.fb_size >> 10,
+ CONFIG_SUNXI_MAX_FB_SIZE >> 10);
+ return NULL;
+ }
+
+ printf("Setting up a %dx%d%s %s console (overscan %dx%d)\n",
+ mode->xres, mode->yres,
+ (mode->vmode == FB_VMODE_INTERLACED) ? "i" : "",
+ sunxi_get_mon_desc(sunxi_display.monitor),
+ overscan_x, overscan_y);
+
+ gd->fb_base = gd->bd->bi_dram[0].start +
+ gd->bd->bi_dram[0].size - sunxi_display.fb_size;
+ sunxi_engines_init();
+
+ fb_dma_addr = gd->fb_base;
+ sunxi_display.fb_addr = gd->fb_base;
+ if (overscan_offset) {
+ fb_dma_addr += 0x1000 - (overscan_offset & 0xfff);
+ sunxi_display.fb_addr += (overscan_offset + 0xfff) & ~0xfff;
+ memset((void *)gd->fb_base, 0, sunxi_display.fb_size);
+ flush_cache(gd->fb_base, sunxi_display.fb_size);
+ }
+ sunxi_mode_set(mode, fb_dma_addr);
+
+ /*
+ * These are the only members of this structure that are used. All the
+ * others are driver specific. The pitch is stored in plnSizeX.
+ */
+ graphic_device->frameAdrs = sunxi_display.fb_addr;
+ graphic_device->gdfIndex = GDF_32BIT_X888RGB;
+ graphic_device->gdfBytesPP = 4;
+ graphic_device->winSizeX = mode->xres - 2 * overscan_x;
+ graphic_device->winSizeY = mode->yres - 2 * overscan_y;
+ graphic_device->plnSizeX = mode->xres * graphic_device->gdfBytesPP;
+
+ return graphic_device;
+}
+
+/*
+ * Simplefb support.
+ */
+#if defined(CONFIG_OF_BOARD_SETUP) && defined(CONFIG_VIDEO_DT_SIMPLEFB)
+int sunxi_simplefb_setup(void *blob)
+{
+ static GraphicDevice *graphic_device = &sunxi_display.graphic_device;
+ int offset, ret;
+ u64 start, size;
+ const char *pipeline = NULL;
+
+ switch (sunxi_display.monitor) {
+ case sunxi_monitor_none:
+ return 0;
+ case sunxi_monitor_dvi:
+ case sunxi_monitor_hdmi:
+ pipeline = "de0-lcd0-hdmi";
+ break;
+ }
+
+ /* Find a prefilled simpefb node, matching out pipeline config */
+ offset = fdt_node_offset_by_compatible(blob, -1,
+ "allwinner,simple-framebuffer");
+ while (offset >= 0) {
+ ret = fdt_stringlist_search(blob, offset, "allwinner,pipeline",
+ pipeline);
+ if (ret == 0)
+ break;
+ offset = fdt_node_offset_by_compatible(blob, offset,
+ "allwinner,simple-framebuffer");
+ }
+ if (offset < 0) {
+ eprintf("Cannot setup simplefb: node not found\n");
+ return 0; /* Keep older kernels working */
+ }
+
+ /*
+ * Do not report the framebuffer as free RAM to the OS, note we cannot
+ * use fdt_add_mem_rsv() here, because then it is still seen as RAM,
+ * and e.g. Linux refuses to iomap RAM on ARM, see:
+ * linux/arch/arm/mm/ioremap.c around line 301.
+ */
+ start = gd->bd->bi_dram[0].start;
+ size = gd->bd->bi_dram[0].size - sunxi_display.fb_size;
+ ret = fdt_fixup_memory_banks(blob, &start, &size, 1);
+ if (ret) {
+ eprintf("Cannot setup simplefb: Error reserving memory\n");
+ return ret;
+ }
+
+ ret = fdt_setup_simplefb_node(blob, offset, sunxi_display.fb_addr,
+ graphic_device->winSizeX, graphic_device->winSizeY,
+ graphic_device->plnSizeX, "x8r8g8b8");
+ if (ret)
+ eprintf("Cannot setup simplefb: Error setting properties\n");
+
+ return ret;
+}
+#endif /* CONFIG_OF_BOARD_SETUP && CONFIG_VIDEO_DT_SIMPLEFB */
diff --git a/include/configs/sunxi-common.h b/include/configs/sunxi-common.h
index b0bfc0d..818408f 100644
--- a/include/configs/sunxi-common.h
+++ b/include/configs/sunxi-common.h
@@ -276,16 +276,23 @@ extern int soft_i2c_gpio_scl;
#define CONFIG_SUNXI_GPIO
#ifdef CONFIG_VIDEO
+/* Do we want to initialize a simple FB? */
+#define CONFIG_VIDEO_DT_SIMPLEFB
+#ifdef CONFIG_MACH_SUN8I_H3
+#define CONFIG_VIDEO_SUNXI2
+#else
+#define CONFIG_VIDEO_SUNXI
+#endif
+
/*
* The amount of RAM to keep free at the top of RAM when relocating u-boot,
* to use as framebuffer. This must be a multiple of 4096.
*/
+#ifdef CONFIG_VIDEO_SUNXI2
+#define CONFIG_SUNXI_MAX_FB_SIZE (32 << 20)
+#else
#define CONFIG_SUNXI_MAX_FB_SIZE (16 << 20)
-
-/* Do we want to initialize a simple FB? */
-#define CONFIG_VIDEO_DT_SIMPLEFB
-
-#define CONFIG_VIDEO_SUNXI
+#endif
#define CONFIG_VIDEO_LOGO
#define CONFIG_VIDEO_STD_TIMINGS
diff --git a/scripts/config_whitelist.txt b/scripts/config_whitelist.txt
index 8814841..fdee9d9 100644
--- a/scripts/config_whitelist.txt
+++ b/scripts/config_whitelist.txt
@@ -8165,6 +8165,7 @@ CONFIG_VIDEO_SM501_8BPP
CONFIG_VIDEO_SM501_PCI
CONFIG_VIDEO_STD_TIMINGS
CONFIG_VIDEO_SUNXI
+CONFIG_VIDEO_SUNXI2
CONFIG_VIDEO_VCXK
CONFIG_VID_FLS_ENV
CONFIG_VM86
--
2.10.2
More information about the U-Boot
mailing list