xref: /rk3399_rockchip-uboot/arch/mips/mach-ath79/qca953x/ddr.c (revision dc557e9a1fe00ca9d884bd88feef5bebf23fede4)
19b03f802SWills Wang /*
29b03f802SWills Wang  * Copyright (C) 2015-2016 Wills Wang <wills.wang@live.com>
39b03f802SWills Wang  * Based on Atheros LSDK/QSDK
49b03f802SWills Wang  *
59b03f802SWills Wang  * SPDX-License-Identifier: GPL-2.0+
69b03f802SWills Wang  */
79b03f802SWills Wang 
89b03f802SWills Wang #include <common.h>
99b03f802SWills Wang #include <asm/io.h>
109b03f802SWills Wang #include <asm/addrspace.h>
119b03f802SWills Wang #include <asm/types.h>
129b03f802SWills Wang #include <mach/ar71xx_regs.h>
13*37523917SWills Wang #include <mach/ath79.h>
149b03f802SWills Wang 
159b03f802SWills Wang DECLARE_GLOBAL_DATA_PTR;
169b03f802SWills Wang 
179b03f802SWills Wang #define DDR_CTRL_UPD_EMR3S      BIT(5)
189b03f802SWills Wang #define DDR_CTRL_UPD_EMR2S      BIT(4)
199b03f802SWills Wang #define DDR_CTRL_PRECHARGE      BIT(3)
209b03f802SWills Wang #define DDR_CTRL_AUTO_REFRESH   BIT(2)
219b03f802SWills Wang #define DDR_CTRL_UPD_EMRS       BIT(1)
229b03f802SWills Wang #define DDR_CTRL_UPD_MRS        BIT(0)
239b03f802SWills Wang 
249b03f802SWills Wang #define DDR_REFRESH_EN          BIT(14)
259b03f802SWills Wang #define DDR_REFRESH_M           0x3ff
269b03f802SWills Wang #define DDR_REFRESH(x)          ((x) & DDR_REFRESH_M)
279b03f802SWills Wang #define DDR_REFRESH_VAL         (DDR_REFRESH_EN | DDR_REFRESH(312))
289b03f802SWills Wang 
299b03f802SWills Wang #define DDR_TRAS_S              0
309b03f802SWills Wang #define DDR_TRAS_M              0x1f
319b03f802SWills Wang #define DDR_TRAS(x)             (((x) & DDR_TRAS_M) << DDR_TRAS_S)
329b03f802SWills Wang #define DDR_TRCD_M              0xf
339b03f802SWills Wang #define DDR_TRCD_S              5
349b03f802SWills Wang #define DDR_TRCD(x)             (((x) & DDR_TRCD_M) << DDR_TRCD_S)
359b03f802SWills Wang #define DDR_TRP_M               0xf
369b03f802SWills Wang #define DDR_TRP_S               9
379b03f802SWills Wang #define DDR_TRP(x)              (((x) & DDR_TRP_M) << DDR_TRP_S)
389b03f802SWills Wang #define DDR_TRRD_M              0xf
399b03f802SWills Wang #define DDR_TRRD_S              13
409b03f802SWills Wang #define DDR_TRRD(x)             (((x) & DDR_TRRD_M) << DDR_TRRD_S)
419b03f802SWills Wang #define DDR_TRFC_M              0x7f
429b03f802SWills Wang #define DDR_TRFC_S              17
439b03f802SWills Wang #define DDR_TRFC(x)             (((x) & DDR_TRFC_M) << DDR_TRFC_S)
449b03f802SWills Wang #define DDR_TMRD_M              0xf
459b03f802SWills Wang #define DDR_TMRD_S              23
469b03f802SWills Wang #define DDR_TMRD(x)             (((x) & DDR_TMRD_M) << DDR_TMRD_S)
479b03f802SWills Wang #define DDR_CAS_L_M             0x17
489b03f802SWills Wang #define DDR_CAS_L_S             27
499b03f802SWills Wang #define DDR_CAS_L(x)            (((x) & DDR_CAS_L_M) << DDR_CAS_L_S)
509b03f802SWills Wang #define DDR_OPEN                BIT(30)
519b03f802SWills Wang #define DDR1_CONF_REG_VAL       (DDR_TRAS(16) | DDR_TRCD(6) | \
529b03f802SWills Wang 				 DDR_TRP(6) | DDR_TRRD(4) | \
539b03f802SWills Wang 				 DDR_TRFC(7) | DDR_TMRD(5) | \
549b03f802SWills Wang 				 DDR_CAS_L(7) | DDR_OPEN)
559b03f802SWills Wang #define DDR2_CONF_REG_VAL       (DDR_TRAS(27) | DDR_TRCD(9) | \
569b03f802SWills Wang 				 DDR_TRP(9) | DDR_TRRD(7) | \
579b03f802SWills Wang 				 DDR_TRFC(21) | DDR_TMRD(15) | \
589b03f802SWills Wang 				 DDR_CAS_L(17) | DDR_OPEN)
599b03f802SWills Wang 
609b03f802SWills Wang #define DDR_BURST_LEN_S         0
619b03f802SWills Wang #define DDR_BURST_LEN_M         0xf
629b03f802SWills Wang #define DDR_BURST_LEN(x)        ((x) << DDR_BURST_LEN_S)
639b03f802SWills Wang #define DDR_BURST_TYPE          BIT(4)
649b03f802SWills Wang #define DDR_CNTL_OE_EN          BIT(5)
659b03f802SWills Wang #define DDR_PHASE_SEL           BIT(6)
669b03f802SWills Wang #define DDR_CKE                 BIT(7)
679b03f802SWills Wang #define DDR_TWR_S               8
689b03f802SWills Wang #define DDR_TWR_M               0xf
699b03f802SWills Wang #define DDR_TWR(x)              (((x) & DDR_TWR_M) << DDR_TWR_S)
709b03f802SWills Wang #define DDR_TRTW_S              12
719b03f802SWills Wang #define DDR_TRTW_M              0x1f
729b03f802SWills Wang #define DDR_TRTW(x)             (((x) & DDR_TRTW_M) << DDR_TRTW_S)
739b03f802SWills Wang #define DDR_TRTP_S              17
749b03f802SWills Wang #define DDR_TRTP_M              0xf
759b03f802SWills Wang #define DDR_TRTP(x)             (((x) & DDR_TRTP_M) << DDR_TRTP_S)
769b03f802SWills Wang #define DDR_TWTR_S              21
779b03f802SWills Wang #define DDR_TWTR_M              0x1f
789b03f802SWills Wang #define DDR_TWTR(x)             (((x) & DDR_TWTR_M) << DDR_TWTR_S)
799b03f802SWills Wang #define DDR_G_OPEN_L_S          26
809b03f802SWills Wang #define DDR_G_OPEN_L_M          0xf
819b03f802SWills Wang #define DDR_G_OPEN_L(x)         ((x) << DDR_G_OPEN_L_S)
829b03f802SWills Wang #define DDR_HALF_WIDTH_LOW      BIT(31)
839b03f802SWills Wang #define DDR1_CONF2_REG_VAL      (DDR_BURST_LEN(8) | DDR_CNTL_OE_EN | \
849b03f802SWills Wang 				 DDR_CKE | DDR_TWR(13) | DDR_TRTW(14) | \
859b03f802SWills Wang 				 DDR_TRTP(8) | DDR_TWTR(14) | \
869b03f802SWills Wang 				 DDR_G_OPEN_L(6) | DDR_HALF_WIDTH_LOW)
879b03f802SWills Wang #define DDR2_CONF2_REG_VAL      (DDR_BURST_LEN(8) | DDR_CNTL_OE_EN | \
889b03f802SWills Wang 				 DDR_CKE | DDR_TWR(1) | DDR_TRTW(14) | \
899b03f802SWills Wang 				 DDR_TRTP(9) | DDR_TWTR(21) | \
909b03f802SWills Wang 				 DDR_G_OPEN_L(8) | DDR_HALF_WIDTH_LOW)
919b03f802SWills Wang 
929b03f802SWills Wang #define DDR_TWR_MSB             BIT(3)
939b03f802SWills Wang #define DDR_TRAS_MSB            BIT(2)
949b03f802SWills Wang #define DDR_TRFC_MSB_M          0x3
959b03f802SWills Wang #define DDR_TRFC_MSB(x)         (x)
969b03f802SWills Wang #define DDR1_CONF3_REG_VAL      0
979b03f802SWills Wang #define DDR2_CONF3_REG_VAL      (DDR_TWR_MSB | DDR_TRFC_MSB(2))
989b03f802SWills Wang 
999b03f802SWills Wang #define DDR_CTL_SRAM_TSEL       BIT(30)
1009b03f802SWills Wang #define DDR_CTL_SRAM_GE0_SYNC   BIT(20)
1019b03f802SWills Wang #define DDR_CTL_SRAM_GE1_SYNC   BIT(19)
1029b03f802SWills Wang #define DDR_CTL_SRAM_USB_SYNC   BIT(18)
1039b03f802SWills Wang #define DDR_CTL_SRAM_PCIE_SYNC  BIT(17)
1049b03f802SWills Wang #define DDR_CTL_SRAM_WMAC_SYNC  BIT(16)
1059b03f802SWills Wang #define DDR_CTL_SRAM_MISC1_SYNC BIT(15)
1069b03f802SWills Wang #define DDR_CTL_SRAM_MISC2_SYNC BIT(14)
1079b03f802SWills Wang #define DDR_CTL_PAD_DDR2_SEL    BIT(6)
1089b03f802SWills Wang #define DDR_CTL_HALF_WIDTH      BIT(1)
1099b03f802SWills Wang #define DDR_CTL_CONFIG_VAL      (DDR_CTL_SRAM_TSEL | \
1109b03f802SWills Wang 				 DDR_CTL_SRAM_GE0_SYNC | \
1119b03f802SWills Wang 				 DDR_CTL_SRAM_GE1_SYNC | \
1129b03f802SWills Wang 				 DDR_CTL_SRAM_USB_SYNC | \
1139b03f802SWills Wang 				 DDR_CTL_SRAM_PCIE_SYNC | \
1149b03f802SWills Wang 				 DDR_CTL_SRAM_WMAC_SYNC | \
1159b03f802SWills Wang 				 DDR_CTL_HALF_WIDTH)
1169b03f802SWills Wang 
1179b03f802SWills Wang #define DDR_BURST_GE0_MAX_BL_S  0
1189b03f802SWills Wang #define DDR_BURST_GE0_MAX_BL_M  0xf
1199b03f802SWills Wang #define DDR_BURST_GE0_MAX_BL(x) \
1209b03f802SWills Wang 	(((x) & DDR_BURST_GE0_MAX_BL_M) << DDR_BURST_GE0_MAX_BL_S)
1219b03f802SWills Wang #define DDR_BURST_GE1_MAX_BL_S  4
1229b03f802SWills Wang #define DDR_BURST_GE1_MAX_BL_M  0xf
1239b03f802SWills Wang #define DDR_BURST_GE1_MAX_BL(x) \
1249b03f802SWills Wang 	(((x) & DDR_BURST_GE1_MAX_BL_M) << DDR_BURST_GE1_MAX_BL_S)
1259b03f802SWills Wang #define DDR_BURST_PCIE_MAX_BL_S 8
1269b03f802SWills Wang #define DDR_BURST_PCIE_MAX_BL_M 0xf
1279b03f802SWills Wang #define DDR_BURST_PCIE_MAX_BL(x) \
1289b03f802SWills Wang 	(((x) & DDR_BURST_PCIE_MAX_BL_M) << DDR_BURST_PCIE_MAX_BL_S)
1299b03f802SWills Wang #define DDR_BURST_USB_MAX_BL_S  12
1309b03f802SWills Wang #define DDR_BURST_USB_MAX_BL_M  0xf
1319b03f802SWills Wang #define DDR_BURST_USB_MAX_BL(x) \
1329b03f802SWills Wang 	(((x) & DDR_BURST_USB_MAX_BL_M) << DDR_BURST_USB_MAX_BL_S)
1339b03f802SWills Wang #define DDR_BURST_CPU_MAX_BL_S  16
1349b03f802SWills Wang #define DDR_BURST_CPU_MAX_BL_M  0xf
1359b03f802SWills Wang #define DDR_BURST_CPU_MAX_BL(x) \
1369b03f802SWills Wang 	(((x) & DDR_BURST_CPU_MAX_BL_M) << DDR_BURST_CPU_MAX_BL_S)
1379b03f802SWills Wang #define DDR_BURST_RD_MAX_BL_S   20
1389b03f802SWills Wang #define DDR_BURST_RD_MAX_BL_M   0xf
1399b03f802SWills Wang #define DDR_BURST_RD_MAX_BL(x) \
1409b03f802SWills Wang 	(((x) & DDR_BURST_RD_MAX_BL_M) << DDR_BURST_RD_MAX_BL_S)
1419b03f802SWills Wang #define DDR_BURST_WR_MAX_BL_S   24
1429b03f802SWills Wang #define DDR_BURST_WR_MAX_BL_M   0xf
1439b03f802SWills Wang #define DDR_BURST_WR_MAX_BL(x) \
1449b03f802SWills Wang 	(((x) & DDR_BURST_WR_MAX_BL_M) << DDR_BURST_WR_MAX_BL_S)
1459b03f802SWills Wang #define DDR_BURST_RWP_MASK_EN_S 28
1469b03f802SWills Wang #define DDR_BURST_RWP_MASK_EN_M 0x3
1479b03f802SWills Wang #define DDR_BURST_RWP_MASK_EN(x) \
1489b03f802SWills Wang 	(((x) & DDR_BURST_RWP_MASK_EN_M) << DDR_BURST_RWP_MASK_EN_S)
1499b03f802SWills Wang #define DDR_BURST_CPU_PRI_BE    BIT(30)
1509b03f802SWills Wang #define DDR_BURST_CPU_PRI       BIT(31)
1519b03f802SWills Wang #define DDR_BURST_VAL           (DDR_BURST_CPU_PRI_BE | \
1529b03f802SWills Wang 				 DDR_BURST_RWP_MASK_EN(3) | \
1539b03f802SWills Wang 				 DDR_BURST_WR_MAX_BL(4) | \
1549b03f802SWills Wang 				 DDR_BURST_RD_MAX_BL(4) | \
1559b03f802SWills Wang 				 DDR_BURST_CPU_MAX_BL(4) | \
1569b03f802SWills Wang 				 DDR_BURST_USB_MAX_BL(4) | \
1579b03f802SWills Wang 				 DDR_BURST_PCIE_MAX_BL(4) | \
1589b03f802SWills Wang 				 DDR_BURST_GE1_MAX_BL(4) | \
1599b03f802SWills Wang 				 DDR_BURST_GE0_MAX_BL(4))
1609b03f802SWills Wang 
1619b03f802SWills Wang #define DDR_BURST_WMAC_MAX_BL_S 0
1629b03f802SWills Wang #define DDR_BURST_WMAC_MAX_BL_M 0xf
1639b03f802SWills Wang #define DDR_BURST_WMAC_MAX_BL(x) \
1649b03f802SWills Wang 	(((x) & DDR_BURST_WMAC_MAX_BL_M) << DDR_BURST_WMAC_MAX_BL_S)
1659b03f802SWills Wang #define DDR_BURST2_VAL          DDR_BURST_WMAC_MAX_BL(4)
1669b03f802SWills Wang 
1679b03f802SWills Wang #define DDR2_CONF_TWL_S         10
1689b03f802SWills Wang #define DDR2_CONF_TWL_M         0xf
1699b03f802SWills Wang #define DDR2_CONF_TWL(x) \
1709b03f802SWills Wang 	(((x) & DDR2_CONF_TWL_M) << DDR2_CONF_TWL_S)
1719b03f802SWills Wang #define DDR2_CONF_ODT           BIT(9)
1729b03f802SWills Wang #define DDR2_CONF_TFAW_S        2
1739b03f802SWills Wang #define DDR2_CONF_TFAW_M        0x3f
1749b03f802SWills Wang #define DDR2_CONF_TFAW(x) \
1759b03f802SWills Wang 	(((x) & DDR2_CONF_TFAW_M) << DDR2_CONF_TFAW_S)
1769b03f802SWills Wang #define DDR2_CONF_EN            BIT(0)
1779b03f802SWills Wang #define DDR2_CONF_VAL           (DDR2_CONF_TWL(5) | \
1789b03f802SWills Wang 				 DDR2_CONF_TFAW(31) | \
1799b03f802SWills Wang 				 DDR2_CONF_ODT | \
1809b03f802SWills Wang 				 DDR2_CONF_EN)
1819b03f802SWills Wang 
1829b03f802SWills Wang #define DDR1_EXT_MODE_VAL       0
1839b03f802SWills Wang #define DDR2_EXT_MODE_VAL       0x402
1849b03f802SWills Wang #define DDR2_EXT_MODE_OCD_VAL   0x782
1859b03f802SWills Wang #define DDR1_MODE_DLL_VAL       0x133
1869b03f802SWills Wang #define DDR2_MODE_DLL_VAL       0x143
1879b03f802SWills Wang #define DDR1_MODE_VAL           0x33
1889b03f802SWills Wang #define DDR2_MODE_VAL           0x43
1899b03f802SWills Wang #define DDR1_TAP_VAL            0x20
1909b03f802SWills Wang #define DDR2_TAP_VAL            0x10
1919b03f802SWills Wang 
1929b03f802SWills Wang #define DDR_REG_BIST_MASK_ADDR_0        0x2c
1939b03f802SWills Wang #define DDR_REG_BIST_MASK_ADDR_1        0x30
1949b03f802SWills Wang #define DDR_REG_BIST_MASK_AHB_GE0_0     0x34
1959b03f802SWills Wang #define DDR_REG_BIST_COMP_AHB_GE0_0     0x38
1969b03f802SWills Wang #define DDR_REG_BIST_MASK_AHB_GE1_0     0x3c
1979b03f802SWills Wang #define DDR_REG_BIST_COMP_AHB_GE1_0     0x40
1989b03f802SWills Wang #define DDR_REG_BIST_COMP_ADDR_0        0x64
1999b03f802SWills Wang #define DDR_REG_BIST_COMP_ADDR_1        0x68
2009b03f802SWills Wang #define DDR_REG_BIST_MASK_AHB_GE0_1     0x6c
2019b03f802SWills Wang #define DDR_REG_BIST_COMP_AHB_GE0_1     0x70
2029b03f802SWills Wang #define DDR_REG_BIST_MASK_AHB_GE1_1     0x74
2039b03f802SWills Wang #define DDR_REG_BIST_COMP_AHB_GE1_1     0x78
2049b03f802SWills Wang #define DDR_REG_BIST                    0x11c
2059b03f802SWills Wang #define DDR_REG_BIST_STATUS             0x120
2069b03f802SWills Wang 
2079b03f802SWills Wang #define DDR_BIST_COMP_CNT_S     1
2089b03f802SWills Wang #define DDR_BIST_COMP_CNT_M     0xff
2099b03f802SWills Wang #define DDR_BIST_COMP_CNT(x) \
2109b03f802SWills Wang 	(((x) & DDR_BIST_COMP_CNT_M) << DDR_BIST_COMP_CNT_S)
2119b03f802SWills Wang #define DDR_BIST_COMP_CNT_MASK \
2129b03f802SWills Wang 	(DDR_BIST_COMP_CNT_M << DDR_BIST_COMP_CNT_S)
2139b03f802SWills Wang #define DDR_BIST_TEST_START     BIT(0)
2149b03f802SWills Wang #define DDR_BIST_STATUS_DONE    BIT(0)
2159b03f802SWills Wang 
2169b03f802SWills Wang /* 4 Row Address Bits, 4 Column Address Bits, 2 BA bits */
2179b03f802SWills Wang #define DDR_BIST_MASK_ADDR_VAL  0xfa5de83f
2189b03f802SWills Wang 
2199b03f802SWills Wang #define DDR_TAP_MAGIC_VAL       0xaa55aa55
2209b03f802SWills Wang #define DDR_TAP_MAX_VAL         0x40
2219b03f802SWills Wang 
ddr_init(void)2229b03f802SWills Wang void ddr_init(void)
2239b03f802SWills Wang {
2249b03f802SWills Wang 	void __iomem *regs;
2259b03f802SWills Wang 	u32 val;
2269b03f802SWills Wang 
2279b03f802SWills Wang 	regs = map_physmem(AR71XX_DDR_CTRL_BASE, AR71XX_DDR_CTRL_SIZE,
2289b03f802SWills Wang 			   MAP_NOCACHE);
229*37523917SWills Wang 	val = ath79_get_bootstrap();
2309b03f802SWills Wang 	if (val & QCA953X_BOOTSTRAP_DDR1) {
2319b03f802SWills Wang 		writel(DDR_CTL_CONFIG_VAL, regs + QCA953X_DDR_REG_CTL_CONF);
2329b03f802SWills Wang 		udelay(10);
2339b03f802SWills Wang 
2349b03f802SWills Wang 		/* For 16-bit DDR */
2359b03f802SWills Wang 		writel(0xffff, regs + AR71XX_DDR_REG_RD_CYCLE);
2369b03f802SWills Wang 		udelay(100);
2379b03f802SWills Wang 
2389b03f802SWills Wang 		/* Burst size */
2399b03f802SWills Wang 		writel(DDR_BURST_VAL, regs + QCA953X_DDR_REG_BURST);
2409b03f802SWills Wang 		udelay(100);
2419b03f802SWills Wang 		writel(DDR_BURST2_VAL, regs + QCA953X_DDR_REG_BURST2);
2429b03f802SWills Wang 		udelay(100);
2439b03f802SWills Wang 
2449b03f802SWills Wang 		/* AHB maximum timeout */
2459b03f802SWills Wang 		writel(0xfffff, regs + QCA953X_DDR_REG_TIMEOUT_MAX);
2469b03f802SWills Wang 		udelay(100);
2479b03f802SWills Wang 
2489b03f802SWills Wang 		/* DRAM timing */
2499b03f802SWills Wang 		writel(DDR1_CONF_REG_VAL, regs + AR71XX_DDR_REG_CONFIG);
2509b03f802SWills Wang 		udelay(100);
2519b03f802SWills Wang 		writel(DDR1_CONF2_REG_VAL, regs + AR71XX_DDR_REG_CONFIG2);
2529b03f802SWills Wang 		udelay(100);
2539b03f802SWills Wang 		writel(DDR1_CONF3_REG_VAL, regs + QCA953X_DDR_REG_CONFIG3);
2549b03f802SWills Wang 		udelay(100);
2559b03f802SWills Wang 
2569b03f802SWills Wang 		/* Precharge All */
2579b03f802SWills Wang 		writel(DDR_CTRL_PRECHARGE, regs + AR71XX_DDR_REG_CONTROL);
2589b03f802SWills Wang 		udelay(100);
2599b03f802SWills Wang 
2609b03f802SWills Wang 		/* ODT disable, Full strength, Enable DLL */
2619b03f802SWills Wang 		writel(DDR1_EXT_MODE_VAL, regs + AR71XX_DDR_REG_EMR);
2629b03f802SWills Wang 		udelay(100);
2639b03f802SWills Wang 
2649b03f802SWills Wang 		/* Update Extended Mode Register Set (EMRS) */
2659b03f802SWills Wang 		writel(DDR_CTRL_UPD_EMRS, regs + AR71XX_DDR_REG_CONTROL);
2669b03f802SWills Wang 		udelay(100);
2679b03f802SWills Wang 
2689b03f802SWills Wang 		/* Reset DLL, CAS Latency 3, Burst Length 8 */
2699b03f802SWills Wang 		writel(DDR1_MODE_DLL_VAL, regs + AR71XX_DDR_REG_MODE);
2709b03f802SWills Wang 		udelay(100);
2719b03f802SWills Wang 
2729b03f802SWills Wang 		/* Update Mode Register Set (MRS) */
2739b03f802SWills Wang 		writel(DDR_CTRL_UPD_MRS, regs + AR71XX_DDR_REG_CONTROL);
2749b03f802SWills Wang 		udelay(100);
2759b03f802SWills Wang 
2769b03f802SWills Wang 		/* Precharge All */
2779b03f802SWills Wang 		writel(DDR_CTRL_PRECHARGE, regs + AR71XX_DDR_REG_CONTROL);
2789b03f802SWills Wang 		udelay(100);
2799b03f802SWills Wang 
2809b03f802SWills Wang 		/* Auto Refresh */
2819b03f802SWills Wang 		writel(DDR_CTRL_AUTO_REFRESH, regs + AR71XX_DDR_REG_CONTROL);
2829b03f802SWills Wang 		udelay(100);
2839b03f802SWills Wang 		writel(DDR_CTRL_AUTO_REFRESH, regs + AR71XX_DDR_REG_CONTROL);
2849b03f802SWills Wang 		udelay(100);
2859b03f802SWills Wang 
2869b03f802SWills Wang 		/* Normal DLL, CAS Latency 3, Burst Length 8 */
2879b03f802SWills Wang 		writel(DDR1_MODE_VAL, regs + AR71XX_DDR_REG_MODE);
2889b03f802SWills Wang 		udelay(100);
2899b03f802SWills Wang 
2909b03f802SWills Wang 		/* Update Mode Register Set (MRS) */
2919b03f802SWills Wang 		writel(DDR_CTRL_UPD_MRS, regs + AR71XX_DDR_REG_CONTROL);
2929b03f802SWills Wang 		udelay(100);
2939b03f802SWills Wang 
2949b03f802SWills Wang 		/* Refresh time control */
2959b03f802SWills Wang 		writel(DDR_REFRESH_VAL, regs + AR71XX_DDR_REG_REFRESH);
2969b03f802SWills Wang 		udelay(100);
2979b03f802SWills Wang 
2989b03f802SWills Wang 		/* DQS 0 Tap Control */
2999b03f802SWills Wang 		writel(DDR1_TAP_VAL, regs + AR71XX_DDR_REG_TAP_CTRL0);
3009b03f802SWills Wang 
3019b03f802SWills Wang 		/* DQS 1 Tap Control */
3029b03f802SWills Wang 		writel(DDR1_TAP_VAL, regs + AR71XX_DDR_REG_TAP_CTRL1);
3039b03f802SWills Wang 	} else {
3049b03f802SWills Wang 		writel(DDR_CTRL_UPD_EMR2S, regs + AR71XX_DDR_REG_CONTROL);
3059b03f802SWills Wang 		udelay(10);
3069b03f802SWills Wang 		writel(DDR_CTRL_UPD_EMR3S, regs + AR71XX_DDR_REG_CONTROL);
3079b03f802SWills Wang 		udelay(10);
3089b03f802SWills Wang 		writel(DDR_CTL_CONFIG_VAL | DDR_CTL_PAD_DDR2_SEL,
3099b03f802SWills Wang 		       regs + QCA953X_DDR_REG_CTL_CONF);
3109b03f802SWills Wang 		udelay(10);
3119b03f802SWills Wang 
3129b03f802SWills Wang 		/* For 16-bit DDR */
3139b03f802SWills Wang 		writel(0xffff, regs + AR71XX_DDR_REG_RD_CYCLE);
3149b03f802SWills Wang 		udelay(100);
3159b03f802SWills Wang 
3169b03f802SWills Wang 		/* Burst size */
3179b03f802SWills Wang 		writel(DDR_BURST_VAL, regs + QCA953X_DDR_REG_BURST);
3189b03f802SWills Wang 		udelay(100);
3199b03f802SWills Wang 		writel(DDR_BURST2_VAL, regs + QCA953X_DDR_REG_BURST2);
3209b03f802SWills Wang 		udelay(100);
3219b03f802SWills Wang 
3229b03f802SWills Wang 		/* AHB maximum timeout */
3239b03f802SWills Wang 		writel(0xfffff, regs + QCA953X_DDR_REG_TIMEOUT_MAX);
3249b03f802SWills Wang 		udelay(100);
3259b03f802SWills Wang 
3269b03f802SWills Wang 		/* DRAM timing */
3279b03f802SWills Wang 		writel(DDR2_CONF_REG_VAL, regs + AR71XX_DDR_REG_CONFIG);
3289b03f802SWills Wang 		udelay(100);
3299b03f802SWills Wang 		writel(DDR2_CONF2_REG_VAL, regs + AR71XX_DDR_REG_CONFIG2);
3309b03f802SWills Wang 		udelay(100);
3319b03f802SWills Wang 		writel(DDR2_CONF3_REG_VAL, regs + QCA953X_DDR_REG_CONFIG3);
3329b03f802SWills Wang 		udelay(100);
3339b03f802SWills Wang 
3349b03f802SWills Wang 		/* Enable DDR2 */
3359b03f802SWills Wang 		writel(DDR2_CONF_VAL, regs + QCA953X_DDR_REG_DDR2_CONFIG);
3369b03f802SWills Wang 		udelay(100);
3379b03f802SWills Wang 
3389b03f802SWills Wang 		/* Precharge All */
3399b03f802SWills Wang 		writel(DDR_CTRL_PRECHARGE, regs + AR71XX_DDR_REG_CONTROL);
3409b03f802SWills Wang 		udelay(100);
3419b03f802SWills Wang 
3429b03f802SWills Wang 		/* Update Extended Mode Register 2 Set (EMR2S) */
3439b03f802SWills Wang 		writel(DDR_CTRL_UPD_EMR2S, regs + AR71XX_DDR_REG_CONTROL);
3449b03f802SWills Wang 		udelay(100);
3459b03f802SWills Wang 
3469b03f802SWills Wang 		/* Update Extended Mode Register 3 Set (EMR3S) */
3479b03f802SWills Wang 		writel(DDR_CTRL_UPD_EMR3S, regs + AR71XX_DDR_REG_CONTROL);
3489b03f802SWills Wang 		udelay(100);
3499b03f802SWills Wang 
3509b03f802SWills Wang 		/* 150 ohm, Reduced strength, Enable DLL */
3519b03f802SWills Wang 		writel(DDR2_EXT_MODE_VAL, regs + AR71XX_DDR_REG_EMR);
3529b03f802SWills Wang 		udelay(100);
3539b03f802SWills Wang 
3549b03f802SWills Wang 		/* Update Extended Mode Register Set (EMRS) */
3559b03f802SWills Wang 		writel(DDR_CTRL_UPD_EMRS, regs + AR71XX_DDR_REG_CONTROL);
3569b03f802SWills Wang 		udelay(100);
3579b03f802SWills Wang 
3589b03f802SWills Wang 		/* Reset DLL, CAS Latency 4, Burst Length 8 */
3599b03f802SWills Wang 		writel(DDR2_MODE_DLL_VAL, regs + AR71XX_DDR_REG_MODE);
3609b03f802SWills Wang 		udelay(100);
3619b03f802SWills Wang 
3629b03f802SWills Wang 		/* Update Mode Register Set (MRS) */
3639b03f802SWills Wang 		writel(DDR_CTRL_UPD_MRS, regs + AR71XX_DDR_REG_CONTROL);
3649b03f802SWills Wang 		udelay(100);
3659b03f802SWills Wang 
3669b03f802SWills Wang 		/* Precharge All */
3679b03f802SWills Wang 		writel(DDR_CTRL_PRECHARGE, regs + AR71XX_DDR_REG_CONTROL);
3689b03f802SWills Wang 		udelay(100);
3699b03f802SWills Wang 
3709b03f802SWills Wang 		/* Auto Refresh */
3719b03f802SWills Wang 		writel(DDR_CTRL_AUTO_REFRESH, regs + AR71XX_DDR_REG_CONTROL);
3729b03f802SWills Wang 		udelay(100);
3739b03f802SWills Wang 		writel(DDR_CTRL_AUTO_REFRESH, regs + AR71XX_DDR_REG_CONTROL);
3749b03f802SWills Wang 		udelay(100);
3759b03f802SWills Wang 
3769b03f802SWills Wang 		/* Normal DLL, CAS Latency 4, Burst Length 8 */
3779b03f802SWills Wang 		writel(DDR2_MODE_VAL, regs + AR71XX_DDR_REG_MODE);
3789b03f802SWills Wang 		udelay(100);
3799b03f802SWills Wang 
3809b03f802SWills Wang 		/* Mode Register Set (MRS) */
3819b03f802SWills Wang 		writel(DDR_CTRL_UPD_MRS, regs + AR71XX_DDR_REG_CONTROL);
3829b03f802SWills Wang 		udelay(100);
3839b03f802SWills Wang 
3849b03f802SWills Wang 		/* Enable OCD, Enable DLL, Reduced Drive Strength */
3859b03f802SWills Wang 		writel(DDR2_EXT_MODE_OCD_VAL, regs + AR71XX_DDR_REG_EMR);
3869b03f802SWills Wang 		udelay(100);
3879b03f802SWills Wang 
3889b03f802SWills Wang 		/* Update Extended Mode Register Set (EMRS) */
3899b03f802SWills Wang 		writel(DDR_CTRL_UPD_EMRS, regs + AR71XX_DDR_REG_CONTROL);
3909b03f802SWills Wang 		udelay(100);
3919b03f802SWills Wang 
3929b03f802SWills Wang 		/* OCD diable, Enable DLL, Reduced Drive Strength */
3939b03f802SWills Wang 		writel(DDR2_EXT_MODE_VAL, regs + AR71XX_DDR_REG_EMR);
3949b03f802SWills Wang 		udelay(100);
3959b03f802SWills Wang 
3969b03f802SWills Wang 		/* Update Extended Mode Register Set (EMRS) */
3979b03f802SWills Wang 		writel(DDR_CTRL_UPD_EMRS, regs + AR71XX_DDR_REG_CONTROL);
3989b03f802SWills Wang 		udelay(100);
3999b03f802SWills Wang 
4009b03f802SWills Wang 		/* Refresh time control */
4019b03f802SWills Wang 		writel(DDR_REFRESH_VAL, regs + AR71XX_DDR_REG_REFRESH);
4029b03f802SWills Wang 		udelay(100);
4039b03f802SWills Wang 
4049b03f802SWills Wang 		/* DQS 0 Tap Control */
4059b03f802SWills Wang 		writel(DDR2_TAP_VAL, regs + AR71XX_DDR_REG_TAP_CTRL0);
4069b03f802SWills Wang 
4079b03f802SWills Wang 		/* DQS 1 Tap Control */
4089b03f802SWills Wang 		writel(DDR2_TAP_VAL, regs + AR71XX_DDR_REG_TAP_CTRL1);
4099b03f802SWills Wang 	}
4109b03f802SWills Wang }
4119b03f802SWills Wang 
ddr_tap_tuning(void)4129b03f802SWills Wang void ddr_tap_tuning(void)
4139b03f802SWills Wang {
4149b03f802SWills Wang 	void __iomem *regs;
4159b03f802SWills Wang 	u32 val, pass, tap, cnt, tap_val, last, first;
4169b03f802SWills Wang 
4179b03f802SWills Wang 	regs = map_physmem(AR71XX_DDR_CTRL_BASE, AR71XX_DDR_CTRL_SIZE,
4189b03f802SWills Wang 			   MAP_NOCACHE);
4199b03f802SWills Wang 
4209b03f802SWills Wang 	tap_val = readl(regs + AR71XX_DDR_REG_TAP_CTRL0);
4219b03f802SWills Wang 	first = DDR_TAP_MAGIC_VAL;
4229b03f802SWills Wang 	last = 0;
4239b03f802SWills Wang 	cnt = 0;
4249b03f802SWills Wang 	tap = 0;
4259b03f802SWills Wang 
4269b03f802SWills Wang 	do {
4279b03f802SWills Wang 		writel(tap, regs + AR71XX_DDR_REG_TAP_CTRL0);
4289b03f802SWills Wang 		writel(tap, regs + AR71XX_DDR_REG_TAP_CTRL1);
4299b03f802SWills Wang 
4309b03f802SWills Wang 		writel(DDR_BIST_COMP_CNT(8), regs + DDR_REG_BIST_COMP_ADDR_1);
4319b03f802SWills Wang 		writel(DDR_BIST_MASK_ADDR_VAL, regs + DDR_REG_BIST_MASK_ADDR_0);
4329b03f802SWills Wang 		writel(0xffff, regs + DDR_REG_BIST_COMP_AHB_GE0_1);
4339b03f802SWills Wang 		writel(0xffff, regs + DDR_REG_BIST_COMP_AHB_GE1_0);
4349b03f802SWills Wang 		writel(0xffff, regs + DDR_REG_BIST_COMP_AHB_GE1_1);
4359b03f802SWills Wang 		writel(0xffff, regs + DDR_REG_BIST_MASK_AHB_GE0_0);
4369b03f802SWills Wang 		writel(0xffff, regs + DDR_REG_BIST_MASK_AHB_GE0_1);
4379b03f802SWills Wang 		writel(0xffff, regs + DDR_REG_BIST_MASK_AHB_GE1_0);
4389b03f802SWills Wang 		writel(0xffff, regs + DDR_REG_BIST_MASK_AHB_GE1_1);
4399b03f802SWills Wang 		writel(0xffff, regs + DDR_REG_BIST_COMP_AHB_GE0_0);
4409b03f802SWills Wang 
4419b03f802SWills Wang 		/* Start BIST test */
4429b03f802SWills Wang 		writel(DDR_BIST_TEST_START, regs + DDR_REG_BIST);
4439b03f802SWills Wang 
4449b03f802SWills Wang 		do {
4459b03f802SWills Wang 			val = readl(regs + DDR_REG_BIST_STATUS);
4469b03f802SWills Wang 		} while (!(val & DDR_BIST_STATUS_DONE));
4479b03f802SWills Wang 
4489b03f802SWills Wang 		/* Stop BIST test */
4499b03f802SWills Wang 		writel(0, regs + DDR_REG_BIST);
4509b03f802SWills Wang 
4519b03f802SWills Wang 		pass = val & DDR_BIST_COMP_CNT_MASK;
4529b03f802SWills Wang 		pass ^= DDR_BIST_COMP_CNT(8);
4539b03f802SWills Wang 		if (!pass) {
4549b03f802SWills Wang 			if (first != DDR_TAP_MAGIC_VAL) {
4559b03f802SWills Wang 				last = tap;
4569b03f802SWills Wang 			} else  {
4579b03f802SWills Wang 				first = tap;
4589b03f802SWills Wang 				last = tap;
4599b03f802SWills Wang 			}
4609b03f802SWills Wang 			cnt++;
4619b03f802SWills Wang 		}
4629b03f802SWills Wang 		tap++;
4639b03f802SWills Wang 	} while (tap < DDR_TAP_MAX_VAL);
4649b03f802SWills Wang 
4659b03f802SWills Wang 	if (cnt) {
4669b03f802SWills Wang 		tap_val = (first + last) / 2;
4679b03f802SWills Wang 		tap_val %= DDR_TAP_MAX_VAL;
4689b03f802SWills Wang 	}
4699b03f802SWills Wang 
4709b03f802SWills Wang 	writel(tap_val, regs + AR71XX_DDR_REG_TAP_CTRL0);
4719b03f802SWills Wang 	writel(tap_val, regs + AR71XX_DDR_REG_TAP_CTRL1);
4729b03f802SWills Wang }
473