[U-Boot] [linux-sunxi] [PATCH 11/13] sunxi: add DRAM support to H6
Andre Przywara
andre.przywara at arm.com
Wed Jun 27 09:46:33 UTC 2018
Hi,
On 25/06/18 11:37, Icenowy Zheng wrote:
> The Allwinner H6 SoC comes with a set of new DRAM controller+PHY combo.
> Both the controller and the PHY seem to be originate from DesignWare,
> and are similar to the ones in ZynqMP SoCs.
>
> This commit introduces an initial DRAM driver for H6, which contains
> only LPDDR3 support. The currently known SBCs with H6 all come with
> LPDDR3 memory, including Pine H64 and several Orange Pi's.
>
> The BSP DRAM initialization code is closed source and violates GPL. Code
> in this commit is written by experimenting, referring the code/document
> of other users of the IPs (mainly the ZynqMP, as it's the only found PHY
> reference) and disassebling the BSP blob.
>
> Thanks for Jernej Skrabec for review and fix some issues in this driver
> (including the most critical one which made it to work), and rewrite
> some code from register dump!
It seems that you guys really spent a lot of time and work into this,
thanks a lot for that!
Just skimming over the code, that looks vaguely similar to the existing
dram_sunxi_dw.c driver. I guess you considered and dismissed that idea
already, but can you briefly comment on how much effort it would be to
integrate H6 support into that driver?
I guess it would be beneficial for all SoCs to have one driver to rule
them all.
Cheers,
Andre.
>
> Signed-off-by: Icenowy Zheng <icenowy at aosc.io>
> ---
> arch/arm/include/asm/arch-sunxi/dram.h | 2 +
> .../include/asm/arch-sunxi/dram_sun50i_h6.h | 276 +++++++
> arch/arm/mach-sunxi/Kconfig | 6 +
> arch/arm/mach-sunxi/Makefile | 1 +
> arch/arm/mach-sunxi/dram_sun50i_h6.c | 708 ++++++++++++++++++
> 5 files changed, 993 insertions(+)
> create mode 100644 arch/arm/include/asm/arch-sunxi/dram_sun50i_h6.h
> create mode 100644 arch/arm/mach-sunxi/dram_sun50i_h6.c
>
> diff --git a/arch/arm/include/asm/arch-sunxi/dram.h b/arch/arm/include/asm/arch-sunxi/dram.h
> index 80abac95b8..cc11fca8ef 100644
> --- a/arch/arm/include/asm/arch-sunxi/dram.h
> +++ b/arch/arm/include/asm/arch-sunxi/dram.h
> @@ -28,6 +28,8 @@
> #include <asm/arch/dram_sunxi_dw.h>
> #elif defined(CONFIG_MACH_SUN9I)
> #include <asm/arch/dram_sun9i.h>
> +#elif defined(CONFIG_MACH_SUN50I_H6)
> +#include <asm/arch/dram_sun50i_h6.h>
> #else
> #include <asm/arch/dram_sun4i.h>
> #endif
> diff --git a/arch/arm/include/asm/arch-sunxi/dram_sun50i_h6.h b/arch/arm/include/asm/arch-sunxi/dram_sun50i_h6.h
> new file mode 100644
> index 0000000000..fe138b8cc0
> --- /dev/null
> +++ b/arch/arm/include/asm/arch-sunxi/dram_sun50i_h6.h
> @@ -0,0 +1,276 @@
> +/*
> + * H6 dram controller register and constant defines
> + *
> + * (C) Copyright 2017 Icenowy Zheng <icenowy at aosc.io>
> + *
> + * SPDX-License-Identifier: GPL-2.0+
> + */
> +
> +#ifndef _SUNXI_DRAM_SUN50I_H6_H
> +#define _SUNXI_DRAM_SUN50I_H6_H
> +
> +enum sunxi_dram_type {
> + SUNXI_DRAM_TYPE_DDR3 = 3,
> + SUNXI_DRAM_TYPE_DDR4,
> + SUNXI_DRAM_TYPE_LPDDR2 = 6,
> + SUNXI_DRAM_TYPE_LPDDR3,
> +};
> +
> +/*
> + * The following information is mainly retrieved by disassembly and some FPGA
> + * test code of sun50iw3 platform.
> + */
> +struct sunxi_mctl_com_reg {
> + u32 cr; /* 0x000 control register */
> + u8 reserved_0x004[4]; /* 0x004 */
> + u32 unk_0x008; /* 0x008 */
> + u32 tmr; /* 0x00c timer register */
> + u8 reserved_0x010[4]; /* 0x010 */
> + u32 unk_0x014; /* 0x014 */
> + u8 reserved_0x018[8]; /* 0x018 */
> + u32 maer0; /* 0x020 master enable register 0 */
> + u32 maer1; /* 0x024 master enable register 1 */
> + u32 maer2; /* 0x028 master enable register 2 */
> + u8 reserved_0x02c[468]; /* 0x02c */
> + u32 bwcr; /* 0x200 bandwidth control register */
> + u8 reserved_0x204[12]; /* 0x204 */
> + /*
> + * The last master configured by BSP libdram is at 0x49x, so the
> + * size of this struct array is set to 41 (0x29) now.
> + */
> + struct {
> + u32 cfg0; /* 0x0 */
> + u32 cfg1; /* 0x4 */
> + u8 reserved_0x8[8]; /* 0x8 */
> + } master[41]; /* 0x210 + index * 0x10 */
> +};
> +check_member(sunxi_mctl_com_reg, master[40].reserved_0x8, 0x498);
> +
> +/*
> + * The following register information are retrieved from some similar DRAM
> + * controllers, including the DRAM controllers in Allwinner A23/A80 SoCs,
> + * Rockchip RK3328 SoC, NXP i.MX7 SoCs and Xilinx Zynq UltraScale+ SoCs.
> + *
> + * The DRAM controller in Allwinner A23/A80 SoCs and NXP i.MX7 SoCs seems
> + * to be older than the one in Allwinner H6, as the DRAMTMG9 register
> + * is missing in these SoCs. (From the product specifications of these
> + * SoCs they're not capable of DDR4)
> + *
> + * Information sources:
> + * - dram_sun9i.h and dram_sun8i_a23.h in the same directory.
> + * - sdram_rk3328.h from the RK3328 TPL DRAM patchset
> + * - i.MX 7Solo Applications Processor Reference Manual (IMX7SRM)
> + * - Zynq UltraScale+ MPSoC Register Reference (UG1087)
> + */
> +struct sunxi_mctl_ctl_reg {
> + u32 mstr; /* 0x000 */
> + u32 statr; /* 0x004 unused */
> + u32 mstr1; /* 0x008 unused */
> + u32 unk_0x00c; /* 0x00c */
> + u32 mrctrl0; /* 0x010 unused */
> + u32 mrctrl1; /* 0x014 unused */
> + u32 mrstatr; /* 0x018 unused */
> + u32 mrctrl2; /* 0x01c unused */
> + u32 derateen; /* 0x020 unused */
> + u32 derateint; /* 0x024 unused */
> + u8 reserved_0x028[8]; /* 0x028 */
> + u32 pwrctl; /* 0x030 unused */
> + u32 pwrtmg; /* 0x034 unused */
> + u32 hwlpctl; /* 0x038 unused */
> + u8 reserved_0x03c[20]; /* 0x03c */
> + u32 rfshctl0; /* 0x050 unused */
> + u32 rfshctl1; /* 0x054 unused */
> + u8 reserved_0x058[8]; /* 0x05c */
> + u32 rfshctl3; /* 0x060 */
> + u32 rfshtmg; /* 0x064 */
> + u8 reserved_0x068[104]; /* 0x068 reserved for ECC&CRC (from ZynqMP) */
> + u32 init[8]; /* 0x0d0 */
> + u32 dimmctl; /* 0x0f0 unused */
> + u32 rankctl; /* 0x0f4 */
> + u8 reserved_0x0f8[8]; /* 0x0f8 */
> + u32 dramtmg[17]; /* 0x100 */
> + u8 reserved_0x144[60]; /* 0x144 */
> + u32 zqctl[3]; /* 0x180 */
> + u32 zqstat; /* 0x18c unused */
> + u32 dfitmg0; /* 0x190 */
> + u32 dfitmg1; /* 0x194 */
> + u32 dfilpcfg[2]; /* 0x198 unused */
> + u32 dfiupd[3]; /* 0x1a0 */
> + u32 reserved_0x1ac; /* 0x1ac */
> + u32 dfimisc; /* 0x1b0 */
> + u32 dfitmg2; /* 0x1b4 unused, may not exist */
> + u8 reserved_0x1b8[8]; /* 0x1b8 */
> + u32 dbictl; /* 0x1c0 */
> + u8 reserved_0x1c4[60]; /* 0x1c4 */
> + u32 addrmap[12]; /* 0x200 */
> + u8 reserved_0x230[16]; /* 0x230 */
> + u32 odtcfg; /* 0x240 */
> + u32 odtmap; /* 0x244 */
> + u8 reserved_0x248[8]; /* 0x248 */
> + u32 sched[2]; /* 0x250 */
> + u8 reserved_0x258[180]; /* 0x258 */
> + u32 dbgcmd; /* 0x30c unused */
> + u32 dbgstat; /* 0x310 unused */
> + u8 reserved_0x314[12]; /* 0x314 */
> + u32 swctl; /* 0x320 */
> + u32 swstat; /* 0x324 */
> +};
> +check_member(sunxi_mctl_ctl_reg, swstat, 0x324);
> +
> +#define MSTR_DEVICETYPE_DDR3 BIT(0)
> +#define MSTR_DEVICETYPE_LPDDR2 BIT(2)
> +#define MSTR_DEVICETYPE_LPDDR3 BIT(3)
> +#define MSTR_DEVICETYPE_DDR4 BIT(4)
> +#define MSTR_DEVICETYPE_MASK GENMASK(5, 0)
> +#define MSTR_2TMODE BIT(10)
> +#define MSTR_BUSWIDTH_FULL (0 << 12)
> +#define MSTR_BUSWIDTH_HALF (1 << 12)
> +#define MSTR_ACTIVE_RANKS(x) (((x == 2) ? 3 : 1) << 24)
> +#define MSTR_BURST_LENGTH(x) (((x) >> 1) << 16)
> +
> +/*
> + * The following register information is based on Zynq UltraScale+
> + * MPSoC Register Reference, as it's the currently only known
> + * DDR PHY similar to the one used in H6; however although the
> + * map is similar, the bit fields definitions are different.
> + *
> + * Other DesignWare DDR PHY's have similar register names, but the
> + * offset and definitions are both different.
> + */
> +struct sunxi_mctl_phy_reg {
> + u32 ver; /* 0x000 guess based on similar PHYs */
> + u32 pir; /* 0x004 */
> + u8 reserved_0x008[8]; /* 0x008 */
> + /*
> + * The ZynqMP manual didn't document PGCR1, however this register
> + * exists on H6 and referenced by libdram.
> + */
> + u32 pgcr[8]; /* 0x010 */
> + /*
> + * By comparing the hardware and the ZynqMP manual, the PGSR seems
> + * to start at 0x34 on H6.
> + */
> + u8 reserved_0x030[4]; /* 0x030 */
> + u32 pgsr[3]; /* 0x034 */
> + u32 ptr[7]; /* 0x040 */
> + /*
> + * According to ZynqMP reference there's PLLCR0~6 in this area,
> + * but they're tagged "Type B PLL Only" and H6 seems to have
> + * no them.
> + * 0x080 is not present in ZynqMP reference but it seems to be
> + * present on H6.
> + */
> + u8 reserved_0x05c[36]; /* 0x05c */
> + u32 unk_0x080; /* 0x080 */
> + u8 reserved_0x084[4]; /* 0x084 */
> + u32 dxccr; /* 0x088 */
> + u8 reserved_0x08c[4]; /* 0x08c */
> + u32 dsgcr; /* 0x090 */
> + u8 reserved_0x094[4]; /* 0x094 */
> + u32 odtcr; /* 0x098 */
> + u8 reserved_0x09c[4]; /* 0x09c */
> + u32 aacr; /* 0x0a0 */
> + u8 reserved_0x0a4[32]; /* 0x0a4 */
> + u32 gpr1; /* 0x0c4 */
> + u8 reserved_0x0c8[56]; /* 0x0c8 */
> + u32 dcr; /* 0x100 */
> + u8 reserved_0x104[12]; /* 0x104 */
> + u32 dtpr[7]; /* 0x110 */
> + u8 reserved_0x12c[20]; /* 0x12c */
> + u32 rdimmgcr[3]; /* 0x140 */
> + u8 reserved_0x14c[4]; /* 0x14c */
> + u32 rdimmcr[5]; /* 0x150 */
> + u8 reserved_0x164[4]; /* 0x164 */
> + u32 schcr[2]; /* 0x168 */
> + u8 reserved_0x170[16]; /* 0x170 */
> + /*
> + * The ZynqMP manual documents MR0~7, 11~14 and 22.
> + */
> + u32 mr[23]; /* 0x180 */
> + u8 reserved_0x1dc[36]; /* 0x1dc */
> + u32 dtcr[2]; /* 0x200 */
> + u32 dtar[3]; /* 0x208 */
> + u8 reserved_0x214[4]; /* 0x214 */
> + u32 dtdr[2]; /* 0x218 */
> + u8 reserved_0x220[16]; /* 0x220 */
> + u32 dtedr0; /* 0x230 */
> + u32 dtedr1; /* 0x234 */
> + u32 dtedr2; /* 0x238 */
> + u32 vtdr; /* 0x23c */
> + u32 catr[2]; /* 0x240 */
> + u8 reserved_0x248[8];
> + u32 dqsdr[3]; /* 0x250 */
> + u32 dtedr3; /* 0x25c */
> + u8 reserved_0x260[160]; /* 0x260 */
> + u32 dcuar; /* 0x300 */
> + u32 dcudr; /* 0x304 */
> + u32 dcurr; /* 0x308 */
> + u32 dculr; /* 0x30c */
> + u32 dcugcr; /* 0x310 */
> + u32 dcutpr; /* 0x314 */
> + u32 dcusr[2]; /* 0x318 */
> + u8 reserved_0x320[444]; /* 0x320 */
> + u32 rankidr; /* 0x4dc */
> + u32 riocr[6]; /* 0x4e0 */
> + u8 reserved_0x4f8[8]; /* 0x4f8 */
> + u32 aciocr[6]; /* 0x500 */
> + u8 reserved_0x518[8]; /* 0x518 */
> + u32 iovcr[2]; /* 0x520 */
> + u32 vtcr[2]; /* 0x528 */
> + u8 reserved_0x530[16]; /* 0x530 */
> + u32 acbdlr[17]; /* 0x540 */
> + u32 aclcdlr; /* 0x584 */
> + u8 reserved_0x588[24]; /* 0x588 */
> + u32 acmdlr[2]; /* 0x5a0 */
> + u8 reserved_0x5a8[216]; /* 0x5a8 */
> + struct {
> + u32 zqcr; /* 0x00 only the first one valid */
> + u32 zqpr[2]; /* 0x04 */
> + u32 zqdr[2]; /* 0x0c */
> + u32 zqor[2]; /* 0x14 */
> + u32 zqsr; /* 0x1c */
> + } zq[2]; /* 0x680, 0x6a0 */
> + u8 reserved_0x6c0[64]; /* 0x6c0 */
> + struct {
> + u32 gcr[7]; /* 0x00 */
> + u8 reserved_0x1c[36]; /* 0x1c */
> + u32 bdlr0; /* 0x40 */
> + u32 bdlr1; /* 0x44 */
> + u32 bdlr2; /* 0x48 */
> + u8 reserved_0x4c[4]; /* 0x4c */
> + u32 bdlr3; /* 0x50 */
> + u32 bdlr4; /* 0x54 */
> + u32 bdlr5; /* 0x58 */
> + u8 reserved_0x5c[4]; /* 0x5c */
> + u32 bdlr6; /* 0x60 */
> + u8 reserved_0x64[28]; /* 0x64 */
> + u32 lcdlr[6]; /* 0x80 */
> + u8 reserved_0x98[8]; /* 0x98 */
> + u32 mdlr[2]; /* 0xa0 */
> + u8 reserved_0xa8[24]; /* 0xa8 */
> + u32 gtr0; /* 0xc0 */
> + u8 reserved_0xc4[12]; /* 0xc4 */
> + /*
> + * DXnRSR0 is not documented in ZynqMP manual but
> + * it's used in libdram.
> + */
> + u32 rsr[4]; /* 0xd0 */
> + u32 gsr[4]; /* 0xe0 */
> + u8 reserved_0xf0[16]; /* 0xf0 */
> + } dx[4]; /* 0x700, 0x800, 0x900, 0xa00 */
> +};
> +check_member(sunxi_mctl_phy_reg, dx[3].reserved_0xf0, 0xaf0);
> +
> +#define DCR_LPDDR3 (1 << 0)
> +#define DCR_DDR3 (3 << 0)
> +#define DCR_DDR4 (4 << 0)
> +#define DCR_DDR8BANK BIT(3)
> +
> +static inline int ns_to_t(int nanoseconds)
> +{
> + const unsigned int ctrl_freq = CONFIG_DRAM_CLK / 2;
> +
> + return DIV_ROUND_UP(ctrl_freq * nanoseconds, 1000);
> +}
> +
> +#endif /* _SUNXI_DRAM_SUN50I_H6_H */
> diff --git a/arch/arm/mach-sunxi/Kconfig b/arch/arm/mach-sunxi/Kconfig
> index e3c19b7464..c2fa0533e7 100644
> --- a/arch/arm/mach-sunxi/Kconfig
> +++ b/arch/arm/mach-sunxi/Kconfig
> @@ -42,6 +42,12 @@ config DRAM_SUN9I
> Select this dram controller driver for Sun9i platforms,
> like A80.
>
> +config DRAM_SUN50I_H6
> + bool
> + help
> + Select this dram controller driver for some sun50i platforms,
> + like H6.
> +
> config SUN6I_P2WI
> bool "Allwinner sun6i internal P2WI controller"
> help
> diff --git a/arch/arm/mach-sunxi/Makefile b/arch/arm/mach-sunxi/Makefile
> index bafeb59d64..a00d4b335d 100644
> --- a/arch/arm/mach-sunxi/Makefile
> +++ b/arch/arm/mach-sunxi/Makefile
> @@ -40,4 +40,5 @@ obj-$(CONFIG_DRAM_SUN9I) += dram_sun9i.o
> obj-$(CONFIG_SPL_SPI_SUNXI) += spl_spi_sunxi.o
> obj-$(CONFIG_SUNXI_DRAM_DW) += dram_sunxi_dw.o
> obj-$(CONFIG_SUNXI_DRAM_DW) += dram_timings/
> +obj-$(CONFIG_DRAM_SUN50I_H6) += dram_sun50i_h6.o
> endif
> diff --git a/arch/arm/mach-sunxi/dram_sun50i_h6.c b/arch/arm/mach-sunxi/dram_sun50i_h6.c
> new file mode 100644
> index 0000000000..c7c4ea9ba7
> --- /dev/null
> +++ b/arch/arm/mach-sunxi/dram_sun50i_h6.c
> @@ -0,0 +1,708 @@
> +/*
> + * sun50i H6 platform dram controller init
> + *
> + * (C) Copyright 2017 Icenowy Zheng <icenowy at aosc.io>
> + *
> + * SPDX-License-Identifier: GPL-2.0+
> + */
> +#include <common.h>
> +#include <asm/io.h>
> +#include <asm/arch/clock.h>
> +#include <asm/arch/dram.h>
> +#include <asm/arch/cpu.h>
> +#include <linux/bitops.h>
> +#include <linux/kconfig.h>
> +
> +/*
> + * The delay parameters below allow to allegedly specify delay times of some
> + * unknown unit for each individual bit trace in each of the four data bytes
> + * the 32-bit wide access consists of. Also three control signals can be
> + * adjusted individually.
> + */
> +#define NR_OF_BYTE_LANES (32 / BITS_PER_BYTE)
> +/* The eight data lines (DQn) plus DM, DQS, DQS/DM/DQ Output Enable and DQSN */
> +#define WR_LINES_PER_BYTE_LANE (BITS_PER_BYTE + 4)
> +/*
> + * The eight data lines (DQn) plus DM, DQS, DQS/DM/DQ Output Enable, DQSN,
> + * Termination and Power down
> + */
> +#define RD_LINES_PER_BYTE_LANE (BITS_PER_BYTE + 6)
> +struct dram_para {
> + u32 clk;
> + enum sunxi_dram_type type;
> + u8 cols;
> + u8 rows;
> + u8 ranks;
> + const u8 dx_read_delays[NR_OF_BYTE_LANES][RD_LINES_PER_BYTE_LANE];
> + const u8 dx_write_delays[NR_OF_BYTE_LANES][WR_LINES_PER_BYTE_LANE];
> +};
> +
> +static void mctl_sys_init(struct dram_para *para);
> +static void mctl_com_init(struct dram_para *para);
> +static void mctl_set_timing_lpddr3(struct dram_para *para);
> +static void mctl_channel_init(struct dram_para *para);
> +
> +static void mctl_core_init(struct dram_para *para)
> +{
> + mctl_sys_init(para);
> + mctl_com_init(para);
> + switch (para->type) {
> + case SUNXI_DRAM_TYPE_LPDDR3:
> + mctl_set_timing_lpddr3(para);
> + break;
> + default:
> + panic("Unsupported DRAM type!");
> + };
> + mctl_channel_init(para);
> +}
> +
> +static void mctl_phy_pir_init(u32 val)
> +{
> + struct sunxi_mctl_phy_reg * const mctl_phy =
> + (struct sunxi_mctl_phy_reg *)SUNXI_DRAM_PHY0_BASE;
> +
> + writel(val | BIT(0), &mctl_phy->pir);
> + mctl_await_completion(&mctl_phy->pgsr[0], BIT(0), BIT(0));
> +}
> +
> +enum {
> + MBUS_PORT_CPU = 0,
> + MBUS_PORT_GPU = 1,
> + MBUS_PORT_MAHB = 2,
> + MBUS_PORT_DMA = 3,
> + MBUS_PORT_VE = 4,
> + MBUS_PORT_CE = 5,
> + MBUS_PORT_TSC0 = 6,
> + MBUS_PORT_NDFC0 = 8,
> + MBUS_PORT_CSI0 = 11,
> + MBUS_PORT_DI0 = 14,
> + MBUS_PORT_DI1 = 15,
> + MBUS_PORT_DE300 = 16,
> + MBUS_PORT_IOMMU = 25,
> + MBUS_PORT_VE2 = 26,
> + MBUS_PORT_USB3 = 37,
> + MBUS_PORT_PCIE = 38,
> + MBUS_PORT_VP9 = 39,
> + MBUS_PORT_HDCP2 = 40,
> +};
> +
> +enum {
> + MBUS_QOS_LOWEST = 0,
> + MBUS_QOS_LOW,
> + MBUS_QOS_HIGH,
> + MBUS_QOS_HIGHEST
> +};
> +inline void mbus_configure_port(u8 port,
> + bool bwlimit,
> + bool priority,
> + u8 qos,
> + u8 waittime,
> + u8 acs,
> + u16 bwl0,
> + u16 bwl1,
> + u16 bwl2)
> +{
> + struct sunxi_mctl_com_reg * const mctl_com =
> + (struct sunxi_mctl_com_reg *)SUNXI_DRAM_COM_BASE;
> +
> + const u32 cfg0 = ( (bwlimit ? (1 << 0) : 0)
> + | (priority ? (1 << 1) : 0)
> + | ((qos & 0x3) << 2)
> + | ((waittime & 0xf) << 4)
> + | ((acs & 0xff) << 8)
> + | (bwl0 << 16) );
> + const u32 cfg1 = ((u32)bwl2 << 16) | (bwl1 & 0xffff);
> +
> + debug("MBUS port %d cfg0 %08x cfg1 %08x\n", port, cfg0, cfg1);
> + writel(cfg0, &mctl_com->master[port].cfg0);
> + writel(cfg1, &mctl_com->master[port].cfg1);
> +}
> +
> +#define MBUS_CONF(port, bwlimit, qos, acs, bwl0, bwl1, bwl2) \
> + mbus_configure_port(MBUS_PORT_ ## port, bwlimit, false, \
> + MBUS_QOS_ ## qos, 0, acs, bwl0, bwl1, bwl2)
> +
> +static void mctl_set_master_priority(void)
> +{
> + struct sunxi_mctl_com_reg * const mctl_com =
> + (struct sunxi_mctl_com_reg *)SUNXI_DRAM_COM_BASE;
> +
> + /* enable bandwidth limit windows and set windows size 1us */
> + writel(399, &mctl_com->tmr);
> + writel(BIT(16), &mctl_com->bwcr);
> +
> + MBUS_CONF( CPU, true, HIGHEST, 0, 256, 128, 100);
> + MBUS_CONF( GPU, true, HIGH, 0, 1536, 1400, 256);
> + MBUS_CONF( MAHB, true, HIGHEST, 0, 512, 256, 96);
> + MBUS_CONF( DMA, true, HIGH, 0, 256, 100, 80);
> + MBUS_CONF( VE, true, HIGH, 2, 8192, 5500, 5000);
> + MBUS_CONF( CE, true, HIGH, 2, 100, 64, 32);
> + MBUS_CONF( TSC0, true, HIGH, 2, 100, 64, 32);
> + MBUS_CONF(NDFC0, true, HIGH, 0, 256, 128, 64);
> + MBUS_CONF( CSI0, true, HIGH, 0, 256, 128, 100);
> + MBUS_CONF( DI0, true, HIGH, 0, 1024, 256, 64);
> + MBUS_CONF(DE300, true, HIGHEST, 6, 8192, 2800, 2400);
> + MBUS_CONF(IOMMU, true, HIGHEST, 0, 100, 64, 32);
> + MBUS_CONF( VE2, true, HIGH, 2, 8192, 5500, 5000);
> + MBUS_CONF( USB3, true, HIGH, 0, 256, 128, 64);
> + MBUS_CONF( PCIE, true, HIGH, 2, 100, 64, 32);
> + MBUS_CONF( VP9, true, HIGH, 2, 8192, 5500, 5000);
> + MBUS_CONF(HDCP2, true, HIGH, 2, 100, 64, 32);
> +}
> +
> +static u32 mr_lpddr3[12] = {
> + 0x00000000, 0x00000043, 0x0000001a, 0x00000001,
> + 0x00000000, 0x00000000, 0x00000048, 0x00000000,
> + 0x00000000, 0x00000000, 0x00000000, 0x00000003,
> +};
> +
> +/* TODO: flexible timing */
> +static void mctl_set_timing_lpddr3(struct dram_para *para)
> +{
> + struct sunxi_mctl_ctl_reg * const mctl_ctl =
> + (struct sunxi_mctl_ctl_reg *)SUNXI_DRAM_CTL0_BASE;
> + struct sunxi_mctl_phy_reg * const mctl_phy =
> + (struct sunxi_mctl_phy_reg *)SUNXI_DRAM_PHY0_BASE;
> +
> + u8 tccd = 2;
> + u8 tfaw = max(ns_to_t(50), 4);
> + u8 trrd = max(ns_to_t(10), 2);
> + u8 trcd = max(ns_to_t(24), 2);
> + u8 trc = ns_to_t(70);
> + u8 txp = max(ns_to_t(8), 2);
> + u8 twtr = max(ns_to_t(8), 2);
> + u8 trtp = max(ns_to_t(8), 2);
> + u8 twr = max(ns_to_t(15), 2);
> + u8 trp = ns_to_t(18);
> + u8 tras = ns_to_t(42);
> + u8 twtr_sa = ns_to_t(5);
> + u8 tcksrea = ns_to_t(11);
> + u16 trefi = ns_to_t(3900) / 32;
> + u16 trfc = ns_to_t(210);
> + u16 txsr = ns_to_t(220);
> +
> + if (CONFIG_DRAM_CLK % 400 == 0) {
> + /* Round up these parameters */
> + twtr_sa++;
> + tcksrea++;
> + }
> +
> + u8 tmrw = 5;
> + u8 tmrd = 5;
> + u8 tmod = 12;
> + u8 tcke = 3;
> + u8 tcksrx = 5;
> + u8 tcksre = 5;
> + u8 tckesr = 5;
> + u8 trasmax = CONFIG_DRAM_CLK / 60;
> + u8 txs = 4;
> + u8 txsdll = 4;
> + u8 txsabort = 4;
> + u8 txsfast = 4;
> +
> + u8 tcl = 5; /* CL 10 */
> + u8 tcwl = 3; /* CWL 6 */
> + u8 t_rdata_en = twtr_sa + 8;
> +
> + u32 tdinit0 = (200 * CONFIG_DRAM_CLK) + 1; /* 200us */
> + u32 tdinit1 = (100 * CONFIG_DRAM_CLK) / 1000 + 1; /* 100ns */
> + u32 tdinit2 = (11 * CONFIG_DRAM_CLK) + 1; /* 11us */
> + u32 tdinit3 = (1 * CONFIG_DRAM_CLK) + 1; /* 1us */
> +
> + u8 twtp = tcwl + 4 + twr + 1;
> + /*
> + * The code below for twr2rd and trd2wr follows the IP core's
> + * document from ZynqMP and i.MX7. The BSP has both number
> + * substracted by 2.
> + */
> + u8 twr2rd = tcwl + 4 + 1 + twtr;
> + u8 trd2wr = tcl + 4 + (tcksrea >> 1) - tcwl + 1;
> +
> + /* set mode register */
> + memcpy(mctl_phy->mr, mr_lpddr3, sizeof(mr_lpddr3));
> +
> + /* set DRAM timing */
> + writel((twtp << 24) | (tfaw << 16) | (trasmax << 8) | tras,
> + &mctl_ctl->dramtmg[0]);
> + writel((txp << 16) | (trtp << 8) | trc, &mctl_ctl->dramtmg[1]);
> + writel((tcwl << 24) | (tcl << 16) | (trd2wr << 8) | twr2rd,
> + &mctl_ctl->dramtmg[2]);
> + writel((tmrw << 20) | (tmrd << 12) | tmod, &mctl_ctl->dramtmg[3]);
> + writel((trcd << 24) | (tccd << 16) | (trrd << 8) | trp,
> + &mctl_ctl->dramtmg[4]);
> + writel((tcksrx << 24) | (tcksre << 16) | (tckesr << 8) | tcke,
> + &mctl_ctl->dramtmg[5]);
> + /* Value suggested by ZynqMP manual and used by libdram */
> + writel((txp + 2) | 0x02020000, &mctl_ctl->dramtmg[6]);
> + writel((txsfast << 24) | (txsabort << 16) | (txsdll << 8) | txs,
> + &mctl_ctl->dramtmg[8]);
> + writel(txsr, &mctl_ctl->dramtmg[14]);
> +
> + clrsetbits_le32(&mctl_ctl->init[0], (3 << 30), (1 << 30));
> + writel(0, &mctl_ctl->dfimisc);
> + clrsetbits_le32(&mctl_ctl->rankctl, 0xff0, 0x660);
> +
> + /*
> + * Set timing registers of the PHY.
> + * Note: the PHY is clocked 2x from the DRAM frequency.
> + */
> + writel((trrd << 25) | (tras << 17) | (trp << 9) | (trtp << 1),
> + &mctl_phy->dtpr[0]);
> + writel((tfaw << 17) | 0x28000400 | (tmrd << 1), &mctl_phy->dtpr[1]);
> + writel(((txs << 6) - 1) | (tcke << 17), &mctl_phy->dtpr[2]);
> + writel(((txsdll << 22) - (0x1 << 16)) | twtr_sa | (tcksrea << 8),
> + &mctl_phy->dtpr[3]);
> + writel((txp << 1) | (trfc << 17) | 0x800, &mctl_phy->dtpr[4]);
> + writel((trc << 17) | (trcd << 9) | (twtr << 1), &mctl_phy->dtpr[5]);
> + writel(0x0505, &mctl_phy->dtpr[6]);
> +
> + /* Configure DFI timing */
> + writel(tcl | 0x2000200 | (t_rdata_en << 16) | 0x808000,
> + &mctl_ctl->dfitmg0);
> + writel(0x040201, &mctl_ctl->dfitmg1);
> +
> + /* Configure PHY timing */
> + writel(tdinit0 | (tdinit1 << 20), &mctl_phy->ptr[3]);
> + writel(tdinit2 | (tdinit3 << 18), &mctl_phy->ptr[4]);
> +
> + /* set refresh timing */
> + writel((trefi << 16) | trfc, &mctl_ctl->rfshtmg);
> +}
> +
> +static void mctl_sys_init(struct dram_para *para)
> +{
> + struct sunxi_ccm_reg * const ccm =
> + (struct sunxi_ccm_reg *)SUNXI_CCM_BASE;
> + struct sunxi_mctl_com_reg * const mctl_com =
> + (struct sunxi_mctl_com_reg *)SUNXI_DRAM_COM_BASE;
> + struct sunxi_mctl_ctl_reg * const mctl_ctl =
> + (struct sunxi_mctl_ctl_reg *)SUNXI_DRAM_CTL0_BASE;
> +
> + /* Put all DRAM-related blocks to reset state */
> + clrbits_le32(&ccm->mbus_cfg, MBUS_ENABLE | MBUS_RESET);
> + writel(0, &ccm->dram_gate_reset);
> + clrbits_le32(&ccm->pll5_cfg, CCM_PLL5_CTRL_EN);
> + clrbits_le32(&ccm->dram_clk_cfg, DRAM_MOD_RESET);
> +
> + udelay(5);
> +
> + /* Set PLL5 rate to doubled DRAM clock rate */
> + writel(CCM_PLL5_CTRL_EN | CCM_PLL5_LOCK_EN |
> + CCM_PLL5_CTRL_N(para->clk * 2 / 24 - 1), &ccm->pll5_cfg);
> + mctl_await_completion(&ccm->pll5_cfg, CCM_PLL5_LOCK, CCM_PLL5_LOCK);
> +
> + /* Configure DRAM mod clock */
> + writel(DRAM_CLK_SRC_PLL5, &ccm->dram_clk_cfg);
> + setbits_le32(&ccm->dram_clk_cfg, DRAM_CLK_UPDATE);
> + writel(BIT(0) | BIT(RESET_SHIFT), &ccm->dram_gate_reset);
> +
> + /* Disable all channels */
> + writel(0, &mctl_com->maer0);
> + writel(0, &mctl_com->maer1);
> + writel(0, &mctl_com->maer2);
> +
> + /* Configure MBUS and enable DRAM mod reset */
> + setbits_le32(&ccm->mbus_cfg, MBUS_RESET);
> + setbits_le32(&ccm->mbus_cfg, MBUS_ENABLE);
> + setbits_le32(&ccm->dram_clk_cfg, DRAM_MOD_RESET);
> + udelay(5);
> +
> + /* Unknown hack from the BSP, which enables access of mctl_ctl regs */
> + writel(0x8000, &mctl_ctl->unk_0x00c);
> +}
> +
> +static void mctl_set_addrmap(struct dram_para *para)
> +{
> + struct sunxi_mctl_ctl_reg * const mctl_ctl =
> + (struct sunxi_mctl_ctl_reg *)SUNXI_DRAM_CTL0_BASE;
> + u8 cols = para->cols;
> + u8 rows = para->rows;
> + u8 ranks = para->ranks;
> +
> + /* Ranks */
> + if (ranks == 2)
> + mctl_ctl->addrmap[0] = rows + cols - 3;
> + else
> + mctl_ctl->addrmap[0] = 0x0F;
> +
> + /* Banks, hardcoded to 8 banks now */
> + mctl_ctl->addrmap[1] = (cols - 2) | (cols - 2) << 8 | (cols - 2) << 16;
> +
> + /* Columns */
> + mctl_ctl->addrmap[2] = 0;
> + switch (cols) {
> + case 8:
> + mctl_ctl->addrmap[3] = 0x1F1F0000;
> + mctl_ctl->addrmap[4] = 0x1F1F;
> + break;
> + case 9:
> + mctl_ctl->addrmap[3] = 0x1F000000;
> + mctl_ctl->addrmap[4] = 0x1F1F;
> + break;
> + case 10:
> + mctl_ctl->addrmap[3] = 0;
> + mctl_ctl->addrmap[4] = 0x1F1F;
> + break;
> + case 11:
> + mctl_ctl->addrmap[3] = 0;
> + mctl_ctl->addrmap[4] = 0x1F00;
> + break;
> + case 12:
> + mctl_ctl->addrmap[3] = 0;
> + mctl_ctl->addrmap[4] = 0;
> + break;
> + default:
> + panic("Unsupported DRAM configuration: column number invalid\n");
> + }
> +
> + /* Rows */
> + mctl_ctl->addrmap[5] = (cols - 3) | ((cols - 3) << 8) | ((cols - 3) << 16) | ((cols - 3) << 24);
> + switch (rows) {
> + case 13:
> + mctl_ctl->addrmap[6] = (cols - 3) | 0x0F0F0F00;
> + mctl_ctl->addrmap[7] = 0x0F0F;
> + break;
> + case 14:
> + mctl_ctl->addrmap[6] = (cols - 3) | ((cols - 3) << 8) | 0x0F0F0000;
> + mctl_ctl->addrmap[7] = 0x0F0F;
> + break;
> + case 15:
> + mctl_ctl->addrmap[6] = (cols - 3) | ((cols - 3) << 8) | ((cols - 3) << 16) | 0x0F000000;
> + mctl_ctl->addrmap[7] = 0x0F0F;
> + break;
> + case 16:
> + mctl_ctl->addrmap[6] = (cols - 3) | ((cols - 3) << 8) | ((cols - 3) << 16) | ((cols - 3) << 24);
> + mctl_ctl->addrmap[7] = 0x0F0F;
> + break;
> + case 17:
> + mctl_ctl->addrmap[6] = (cols - 3) | ((cols - 3) << 8) | ((cols - 3) << 16) | ((cols - 3) << 24);
> + mctl_ctl->addrmap[7] = (cols - 3) | 0x0F00;
> + break;
> + case 18:
> + mctl_ctl->addrmap[6] = (cols - 3) | ((cols - 3) << 8) | ((cols - 3) << 16) | ((cols - 3) << 24);
> + mctl_ctl->addrmap[7] = (cols - 3) | ((cols - 3) << 8);
> + break;
> + default:
> + panic("Unsupported DRAM configuration: row number invalid\n");
> + }
> +
> + /* Bank groups, DDR4 only */
> + mctl_ctl->addrmap[8] = 0x3F3F;
> +}
> +
> +static void mctl_com_init(struct dram_para *para)
> +{
> + struct sunxi_mctl_com_reg * const mctl_com =
> + (struct sunxi_mctl_com_reg *)SUNXI_DRAM_COM_BASE;
> + struct sunxi_mctl_ctl_reg * const mctl_ctl =
> + (struct sunxi_mctl_ctl_reg *)SUNXI_DRAM_CTL0_BASE;
> + struct sunxi_mctl_phy_reg * const mctl_phy =
> + (struct sunxi_mctl_phy_reg *)SUNXI_DRAM_PHY0_BASE;
> + u32 reg_val, tmp;
> +
> + mctl_set_addrmap(para);
> +
> + setbits_le32(&mctl_com->cr, BIT(31));
> + /*
> + * This address is magic; it's in SID memory area, but there's no
> + * known definition of it.
> + * On my Pine H64 board it has content 7.
> + */
> + if (readl(0x03006100) == 7)
> + clrbits_le32(&mctl_com->cr, BIT(27));
> + else if (readl(0x03006100) == 3)
> + setbits_le32(&mctl_com->cr, BIT(27));
> +
> + if (para->clk > 408)
> + reg_val = 0xf00;
> + else if (para->clk > 246)
> + reg_val = 0x1f00;
> + else
> + reg_val = 0x3f00;
> + clrsetbits_le32(&mctl_com->unk_0x008, 0x3f00, reg_val);
> +
> + /* TODO: half DQ, non-LPDDR3 types */
> + writel(MSTR_DEVICETYPE_LPDDR3 | MSTR_BUSWIDTH_FULL |
> + MSTR_BURST_LENGTH(8) | MSTR_ACTIVE_RANKS(para->ranks) |
> + 0x80000000, &mctl_ctl->mstr);
> + writel(DCR_LPDDR3 | DCR_DDR8BANK | 0x400, &mctl_phy->dcr);
> +
> + if (para->ranks == 2)
> + writel(0x0303, &mctl_ctl->odtmap);
> + else
> + writel(0x0201, &mctl_ctl->odtmap);
> +
> + /* TODO: non-LPDDR3 types */
> + tmp = para->clk * 7 / 2000;
> + reg_val = 0x0400;
> + reg_val |= (tmp + 7) << 24;
> + reg_val |= (((para->clk < 400) ? 3 : 4) - tmp) << 16;
> + writel(reg_val, &mctl_ctl->odtcfg);
> +
> + /* TODO: half DQ */
> +}
> +
> +static void mctl_bit_delay_set(struct dram_para *para)
> +{
> + struct sunxi_mctl_phy_reg * const mctl_phy =
> + (struct sunxi_mctl_phy_reg *)SUNXI_DRAM_PHY0_BASE;
> + int i, j;
> + u32 val;
> +
> + for (i = 0; i < 4; i++) {
> + val = readl(&mctl_phy->dx[i].bdlr0);
> + for (j = 0; j < 4; j++)
> + val += para->dx_write_delays[i][j] << (j * 8);
> + writel(val, &mctl_phy->dx[i].bdlr0);
> +
> + val = readl(&mctl_phy->dx[i].bdlr1);
> + for (j = 0; j < 4; j++)
> + val += para->dx_write_delays[i][j + 4] << (j * 8);
> + writel(val, &mctl_phy->dx[i].bdlr1);
> +
> + val = readl(&mctl_phy->dx[i].bdlr2);
> + for (j = 0; j < 4; j++)
> + val += para->dx_write_delays[i][j + 8] << (j * 8);
> + writel(val, &mctl_phy->dx[i].bdlr2);
> + }
> + clrbits_le32(&mctl_phy->pgcr[0], BIT(26));
> +
> + for (i = 0; i < 4; i++) {
> + val = readl(&mctl_phy->dx[i].bdlr3);
> + for (j = 0; j < 4; j++)
> + val += para->dx_read_delays[i][j] << (j * 8);
> + writel(val, &mctl_phy->dx[i].bdlr3);
> +
> + val = readl(&mctl_phy->dx[i].bdlr4);
> + for (j = 0; j < 4; j++)
> + val += para->dx_read_delays[i][j + 4] << (j * 8);
> + writel(val, &mctl_phy->dx[i].bdlr4);
> +
> + val = readl(&mctl_phy->dx[i].bdlr5);
> + for (j = 0; j < 4; j++)
> + val += para->dx_read_delays[i][j + 8] << (j * 8);
> + writel(val, &mctl_phy->dx[i].bdlr5);
> +
> + val = readl(&mctl_phy->dx[i].bdlr6);
> + val += (para->dx_read_delays[i][12] << 8) |
> + (para->dx_read_delays[i][13] << 16);
> + writel(val, &mctl_phy->dx[i].bdlr6);
> + }
> + setbits_le32(&mctl_phy->pgcr[0], BIT(26));
> + udelay(1);
> +
> + for (i = 1; i < 14; i++) {
> + val = readl(&mctl_phy->acbdlr[i]);
> + val += 0x0a0a0a0a;
> + writel(val, &mctl_phy->acbdlr[i]);
> + }
> +}
> +
> +static void mctl_channel_init(struct dram_para *para)
> +{
> + struct sunxi_mctl_com_reg * const mctl_com =
> + (struct sunxi_mctl_com_reg *)SUNXI_DRAM_COM_BASE;
> + struct sunxi_mctl_ctl_reg * const mctl_ctl =
> + (struct sunxi_mctl_ctl_reg *)SUNXI_DRAM_CTL0_BASE;
> + struct sunxi_mctl_phy_reg * const mctl_phy =
> + (struct sunxi_mctl_phy_reg *)SUNXI_DRAM_PHY0_BASE;
> + int i;
> + u32 val;
> +
> + setbits_le32(&mctl_ctl->dfiupd[0], BIT(31) | BIT(30));
> + setbits_le32(&mctl_ctl->zqctl[0], BIT(31) | BIT(30));
> + writel(0x2f05, &mctl_ctl->sched[0]);
> + setbits_le32(&mctl_ctl->rfshctl3, BIT(0));
> + setbits_le32(&mctl_ctl->dfimisc, BIT(0));
> + setbits_le32(&mctl_ctl->unk_0x00c, BIT(8));
> + clrsetbits_le32(&mctl_phy->pgcr[1], 0x180, 0xc0);
> + /* TODO: non-LPDDR3 types */
> + clrsetbits_le32(&mctl_phy->pgcr[2], GENMASK(17, 0), ns_to_t(7800));
> + clrbits_le32(&mctl_phy->pgcr[6], BIT(0));
> + clrsetbits_le32(&mctl_phy->dxccr, 0xee0, 0x220);
> + /* TODO: VT compensation */
> + clrsetbits_le32(&mctl_phy->dsgcr, BIT(0), 0x440060);
> + clrbits_le32(&mctl_phy->vtcr[1], BIT(1));
> +
> + for (i = 0; i < 4; i++)
> + clrsetbits_le32(&mctl_phy->dx[i].gcr[0], 0xe00, 0x800);
> + for (i = 0; i < 4; i++)
> + clrsetbits_le32(&mctl_phy->dx[i].gcr[2], 0xffff, 0x5555);
> + for (i = 0; i < 4; i++)
> + clrsetbits_le32(&mctl_phy->dx[i].gcr[3], 0x3030, 0x1010);
> +
> + udelay(100);
> +
> + if (para->ranks == 2)
> + setbits_le32(&mctl_phy->dtcr[1], 0x30000);
> + else
> + clrsetbits_le32(&mctl_phy->dtcr[1], 0x30000, 0x10000);
> +
> + clrbits_le32(&mctl_phy->dtcr[1], BIT(1));
> + if (para->ranks == 2) {
> + writel(0x00010001, &mctl_phy->rankidr);
> + writel(0x20000, &mctl_phy->odtcr);
> + } else {
> + writel(0x0, &mctl_phy->rankidr);
> + writel(0x10000, &mctl_phy->odtcr);
> + }
> +
> + /* TODO: non-LPDDR3 types */
> + clrsetbits_le32(&mctl_phy->dtcr[0], 0xF0000000, 0x10000040);
> + if (para->clk <= 792) {
> + if (para->clk <= 672) {
> + if (para->clk <= 600)
> + val = 0x300;
> + else
> + val = 0x400;
> + } else {
> + val = 0x500;
> + }
> + } else {
> + val = 0x600;
> + }
> + /* FIXME: NOT REVIEWED YET */
> + clrsetbits_le32(&mctl_phy->zq[0].zqcr, 0x700, val);
> + clrsetbits_le32(&mctl_phy->zq[0].zqpr[0], 0xff,
> + CONFIG_DRAM_ZQ & 0xff);
> + clrbits_le32(&mctl_phy->zq[0].zqor[0], 0xfffff);
> + setbits_le32(&mctl_phy->zq[0].zqor[0], (CONFIG_DRAM_ZQ >> 8) & 0xff);
> + setbits_le32(&mctl_phy->zq[0].zqor[0], (CONFIG_DRAM_ZQ & 0xf00) - 0x100);
> + setbits_le32(&mctl_phy->zq[0].zqor[0], (CONFIG_DRAM_ZQ & 0xff00) << 4);
> + clrbits_le32(&mctl_phy->zq[1].zqpr[0], 0xfffff);
> + setbits_le32(&mctl_phy->zq[1].zqpr[0], (CONFIG_DRAM_ZQ >> 16) & 0xff);
> + setbits_le32(&mctl_phy->zq[1].zqpr[0], ((CONFIG_DRAM_ZQ >> 8) & 0xf00) - 0x100);
> + setbits_le32(&mctl_phy->zq[1].zqpr[0], (CONFIG_DRAM_ZQ & 0xff0000) >> 4);
> + if (para->type == SUNXI_DRAM_TYPE_LPDDR3) {
> + for (i = 1; i < 14; i++)
> + writel(0x06060606, &mctl_phy->acbdlr[i]);
> + }
> +
> + /* TODO: non-LPDDR3 types */
> + mctl_phy_pir_init(0xf562 | BIT(10));
> +
> + /* TODO: non-LPDDR3 types */
> + for (i = 0; i < 4; i++)
> + writel(0x00000909, &mctl_phy->dx[i].gcr[5]);
> +
> + for (i = 0; i < 4; i++) {
> + if (IS_ENABLED(CONFIG_DRAM_ODT_EN))
> + val = 0x0;
> + else
> + val = 0xaaaa;
> + clrsetbits_le32(&mctl_phy->dx[i].gcr[2], 0xffff, val);
> +
> + if (IS_ENABLED(CONFIG_DRAM_ODT_EN))
> + val = 0x0;
> + else
> + val = 0x2020;
> + clrsetbits_le32(&mctl_phy->dx[i].gcr[3], 0x3030, val);
> + }
> +
> + mctl_bit_delay_set(para);
> + udelay(1);
> +
> + setbits_le32(&mctl_phy->pgcr[6], BIT(0));
> + clrbits_le32(&mctl_phy->pgcr[6], 0xfff8);
> + for (i = 0; i < 4; i++)
> + clrbits_le32(&mctl_phy->dx[i].gcr[3], ~0x3ffff);
> + udelay(10);
> +
> + if (readl(&mctl_phy->pgsr[0]) & 0xff00000) {
> + /* Oops! There's something wrong! */
> + debug("PLL = %x\n", readl(0x3001010));
> + debug("DRAM PHY PGSR0 = %x\n", readl(&mctl_phy->pgsr[0]));
> + for (i = 0; i < 4; i++)
> + debug("DRAM PHY DX%dRSR0 = %x\n", i, readl(&mctl_phy->dx[i].rsr[0]));
> + panic("Error while initializing DRAM PHY!\n");
> + }
> +
> + clrsetbits_le32(&mctl_phy->dsgcr, 0xc0, 0x40);
> + clrbits_le32(&mctl_phy->pgcr[1], 0x40);
> + clrbits_le32(&mctl_ctl->dfimisc, BIT(0));
> + writel(1, &mctl_ctl->swctl);
> + mctl_await_completion(&mctl_ctl->swstat, 1, 1);
> + clrbits_le32(&mctl_ctl->rfshctl3, BIT(0));
> +
> + setbits_le32(&mctl_com->unk_0x014, BIT(31));
> + writel(0xffffffff, &mctl_com->maer0);
> + writel(0x7ff, &mctl_com->maer1);
> + writel(0xffff, &mctl_com->maer2);
> +}
> +
> +static void mctl_auto_detect_dram_size(struct dram_para *para)
> +{
> + /* TODO: non-LPDDR3, half DQ */
> + /* detect row address bits */
> + para->cols = 8;
> + para->rows = 18;
> + mctl_core_init(para);
> +
> + for (para->rows = 13; para->rows < 18; para->rows++) {
> + /* 8 banks, 8 bit per byte and 32 bit width */
> + if (mctl_mem_matches((1 << (para->rows + para->cols + 5))))
> + break;
> + }
> +
> + /* detect column address bits */
> + para->cols = 11;
> + mctl_core_init(para);
> +
> + for (para->cols = 8; para->cols < 11; para->cols++) {
> + /* 8 bits per byte and 32 bit width */
> + if (mctl_mem_matches(1 << (para->cols + 2)))
> + break;
> + }
> +}
> +
> +unsigned long mctl_calc_size(struct dram_para *para)
> +{
> + /* TODO: non-LPDDR3, half DQ */
> +
> + /* 8 banks, 32-bit (4 byte) data width */
> + return (1ULL << (para->cols + para->rows + 3)) * 4 * para->ranks;
> +}
> +
> +#define SUN50I_H6_DX_WRITE_DELAYS \
> + {{ 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0 }, \
> + { 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0 }, \
> + { 0, 0, 0, 0, 0, 0, 0, 0, 0, 4, 4, 0 }, \
> + { 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0 }}
> +#define SUN50I_H6_DX_READ_DELAYS \
> + {{ 4, 4, 4, 4, 4, 4, 4, 4, 4, 0, 0, 0, 0, 0 }, \
> + { 4, 4, 4, 4, 4, 4, 4, 4, 4, 0, 0, 0, 0, 0 }, \
> + { 4, 4, 4, 4, 4, 4, 4, 4, 4, 0, 0, 0, 0, 0 }, \
> + { 4, 4, 4, 4, 4, 4, 4, 4, 4, 0, 0, 0, 0, 0 }}
> +
> +unsigned long sunxi_dram_init(void)
> +{
> + struct sunxi_mctl_com_reg * const mctl_com =
> + (struct sunxi_mctl_com_reg *)SUNXI_DRAM_COM_BASE;
> + struct dram_para para = {
> + .clk = CONFIG_DRAM_CLK,
> + .type = SUNXI_DRAM_TYPE_LPDDR3,
> + .ranks = 2,
> + .cols = 11,
> + .rows = 14,
> + .dx_read_delays = SUN50I_H6_DX_READ_DELAYS,
> + .dx_write_delays = SUN50I_H6_DX_WRITE_DELAYS,
> + };
> +
> + unsigned long size;
> +
> + /* RES_CAL_CTRL_REG in BSP U-boot*/
> + setbits_le32(0x7010310, BIT(8));
> + clrbits_le32(0x7010318, 0x3f);
> +
> + mctl_auto_detect_dram_size(¶);
> +
> + mctl_core_init(¶);
> +
> + size = mctl_calc_size(¶);
> +
> + clrsetbits_le32(&mctl_com->cr, 0xf0, (size / 1024 / 1024) & 0xf0);
> +
> + mctl_set_master_priority();
> +
> + return size;
> +};
>
More information about the U-Boot
mailing list