xref: /rk3399_rockchip-uboot/arch/arm/mach-sunxi/dram_sun8i_a33.c (revision 40345e9ea74b0caef06f205364bb2cf93528cc40)
1*e6e505b9SAlexander Graf /*
2*e6e505b9SAlexander Graf  * Sun8i a33 platform dram controller init.
3*e6e505b9SAlexander Graf  *
4*e6e505b9SAlexander Graf  * (C) Copyright 2007-2015 Allwinner Technology Co.
5*e6e505b9SAlexander Graf  *                         Jerry Wang <wangflord@allwinnertech.com>
6*e6e505b9SAlexander Graf  * (C) Copyright 2015      Vishnu Patekar <vishnupatekar0510@gmail.com>
7*e6e505b9SAlexander Graf  * (C) Copyright 2015      Hans de Goede <hdegoede@redhat.com>
8*e6e505b9SAlexander Graf  *
9*e6e505b9SAlexander Graf  * SPDX-License-Identifier:	GPL-2.0+
10*e6e505b9SAlexander Graf  */
11*e6e505b9SAlexander Graf #include <common.h>
12*e6e505b9SAlexander Graf #include <errno.h>
13*e6e505b9SAlexander Graf #include <asm/io.h>
14*e6e505b9SAlexander Graf #include <asm/arch/clock.h>
15*e6e505b9SAlexander Graf #include <asm/arch/dram.h>
16*e6e505b9SAlexander Graf #include <asm/arch/prcm.h>
17*e6e505b9SAlexander Graf 
18*e6e505b9SAlexander Graf /* PLL runs at 2x dram-clk, controller runs at PLL / 4 (dram-clk / 2) */
19*e6e505b9SAlexander Graf #define DRAM_CLK_MUL 2
20*e6e505b9SAlexander Graf #define DRAM_CLK_DIV 4
21*e6e505b9SAlexander Graf #define DRAM_SIGMA_DELTA_ENABLE 1
22*e6e505b9SAlexander Graf 
23*e6e505b9SAlexander Graf struct dram_para {
24*e6e505b9SAlexander Graf 	u8 cs1;
25*e6e505b9SAlexander Graf 	u8 seq;
26*e6e505b9SAlexander Graf 	u8 bank;
27*e6e505b9SAlexander Graf 	u8 rank;
28*e6e505b9SAlexander Graf 	u8 rows;
29*e6e505b9SAlexander Graf 	u8 bus_width;
30*e6e505b9SAlexander Graf 	u16 page_size;
31*e6e505b9SAlexander Graf };
32*e6e505b9SAlexander Graf 
mctl_set_cr(struct dram_para * para)33*e6e505b9SAlexander Graf static void mctl_set_cr(struct dram_para *para)
34*e6e505b9SAlexander Graf {
35*e6e505b9SAlexander Graf 	struct sunxi_mctl_com_reg * const mctl_com =
36*e6e505b9SAlexander Graf 			(struct sunxi_mctl_com_reg *)SUNXI_DRAM_COM_BASE;
37*e6e505b9SAlexander Graf 
38*e6e505b9SAlexander Graf 	writel(MCTL_CR_CS1_CONTROL(para->cs1) | MCTL_CR_UNKNOWN |
39*e6e505b9SAlexander Graf 	       MCTL_CR_CHANNEL(1) | MCTL_CR_DDR3 |
40*e6e505b9SAlexander Graf 	       (para->seq ? MCTL_CR_SEQUENCE : 0) |
41*e6e505b9SAlexander Graf 	       ((para->bus_width == 16) ? MCTL_CR_BUSW16 : MCTL_CR_BUSW8) |
42*e6e505b9SAlexander Graf 	       MCTL_CR_PAGE_SIZE(para->page_size) | MCTL_CR_ROW(para->rows) |
43*e6e505b9SAlexander Graf 	       MCTL_CR_BANK(para->bank) | MCTL_CR_RANK(para->rank),
44*e6e505b9SAlexander Graf 	       &mctl_com->cr);
45*e6e505b9SAlexander Graf }
46*e6e505b9SAlexander Graf 
auto_detect_dram_size(struct dram_para * para)47*e6e505b9SAlexander Graf static void auto_detect_dram_size(struct dram_para *para)
48*e6e505b9SAlexander Graf {
49*e6e505b9SAlexander Graf 	u8 orig_rank = para->rank;
50*e6e505b9SAlexander Graf 	int rows, columns;
51*e6e505b9SAlexander Graf 
52*e6e505b9SAlexander Graf 	/* Row detect */
53*e6e505b9SAlexander Graf 	para->page_size = 512;
54*e6e505b9SAlexander Graf 	para->seq = 1;
55*e6e505b9SAlexander Graf 	para->rows = 16;
56*e6e505b9SAlexander Graf 	para->rank = 1;
57*e6e505b9SAlexander Graf 	mctl_set_cr(para);
58*e6e505b9SAlexander Graf 	for (rows = 11 ; rows < 16 ; rows++) {
59*e6e505b9SAlexander Graf 		if (mctl_mem_matches(1 << (rows + 9))) /* row-column */
60*e6e505b9SAlexander Graf 			break;
61*e6e505b9SAlexander Graf 	}
62*e6e505b9SAlexander Graf 
63*e6e505b9SAlexander Graf 	/* Column (page size) detect */
64*e6e505b9SAlexander Graf 	para->rows = 11;
65*e6e505b9SAlexander Graf 	para->page_size = 8192;
66*e6e505b9SAlexander Graf 	mctl_set_cr(para);
67*e6e505b9SAlexander Graf 	for (columns = 9 ; columns < 13 ; columns++) {
68*e6e505b9SAlexander Graf 		if (mctl_mem_matches(1 << columns))
69*e6e505b9SAlexander Graf 			break;
70*e6e505b9SAlexander Graf 	}
71*e6e505b9SAlexander Graf 
72*e6e505b9SAlexander Graf 	para->seq = 0;
73*e6e505b9SAlexander Graf 	para->rank = orig_rank;
74*e6e505b9SAlexander Graf 	para->rows = rows;
75*e6e505b9SAlexander Graf 	para->page_size = 1 << columns;
76*e6e505b9SAlexander Graf 	mctl_set_cr(para);
77*e6e505b9SAlexander Graf }
78*e6e505b9SAlexander Graf 
ns_to_t(int nanoseconds)79*e6e505b9SAlexander Graf static inline int ns_to_t(int nanoseconds)
80*e6e505b9SAlexander Graf {
81*e6e505b9SAlexander Graf 	const unsigned int ctrl_freq =
82*e6e505b9SAlexander Graf 		CONFIG_DRAM_CLK * DRAM_CLK_MUL / DRAM_CLK_DIV;
83*e6e505b9SAlexander Graf 
84*e6e505b9SAlexander Graf 	return (ctrl_freq * nanoseconds + 999) / 1000;
85*e6e505b9SAlexander Graf }
86*e6e505b9SAlexander Graf 
auto_set_timing_para(struct dram_para * para)87*e6e505b9SAlexander Graf static void auto_set_timing_para(struct dram_para *para)
88*e6e505b9SAlexander Graf {
89*e6e505b9SAlexander Graf 	struct sunxi_mctl_ctl_reg * const mctl_ctl =
90*e6e505b9SAlexander Graf 		(struct sunxi_mctl_ctl_reg *)SUNXI_DRAM_CTL0_BASE;
91*e6e505b9SAlexander Graf 	u32 reg_val;
92*e6e505b9SAlexander Graf 
93*e6e505b9SAlexander Graf 	u8 tccd		= 2;
94*e6e505b9SAlexander Graf 	u8 tfaw		= ns_to_t(50);
95*e6e505b9SAlexander Graf 	u8 trrd		= max(ns_to_t(10), 4);
96*e6e505b9SAlexander Graf 	u8 trcd		= ns_to_t(15);
97*e6e505b9SAlexander Graf 	u8 trc		= ns_to_t(53);
98*e6e505b9SAlexander Graf 	u8 txp		= max(ns_to_t(8), 3);
99*e6e505b9SAlexander Graf 	u8 twtr		= max(ns_to_t(8), 4);
100*e6e505b9SAlexander Graf 	u8 trtp		= max(ns_to_t(8), 4);
101*e6e505b9SAlexander Graf 	u8 twr		= max(ns_to_t(15), 3);
102*e6e505b9SAlexander Graf 	u8 trp		= ns_to_t(15);
103*e6e505b9SAlexander Graf 	u8 tras		= ns_to_t(38);
104*e6e505b9SAlexander Graf 
105*e6e505b9SAlexander Graf 	u16 trefi	= ns_to_t(7800) / 32;
106*e6e505b9SAlexander Graf 	u16 trfc	= ns_to_t(350);
107*e6e505b9SAlexander Graf 
108*e6e505b9SAlexander Graf 	/* Fixed timing parameters */
109*e6e505b9SAlexander Graf 	u8 tmrw		= 0;
110*e6e505b9SAlexander Graf 	u8 tmrd		= 4;
111*e6e505b9SAlexander Graf 	u8 tmod		= 12;
112*e6e505b9SAlexander Graf 	u8 tcke		= 3;
113*e6e505b9SAlexander Graf 	u8 tcksrx	= 5;
114*e6e505b9SAlexander Graf 	u8 tcksre	= 5;
115*e6e505b9SAlexander Graf 	u8 tckesr	= 4;
116*e6e505b9SAlexander Graf 	u8 trasmax	= 24;
117*e6e505b9SAlexander Graf 	u8 tcl		= 6; /* CL 12 */
118*e6e505b9SAlexander Graf 	u8 tcwl		= 4; /* CWL 8 */
119*e6e505b9SAlexander Graf 	u8 t_rdata_en	= 4;
120*e6e505b9SAlexander Graf 	u8 wr_latency	= 2;
121*e6e505b9SAlexander Graf 
122*e6e505b9SAlexander Graf 	u32 tdinit0	= (500 * CONFIG_DRAM_CLK) + 1;		/* 500us */
123*e6e505b9SAlexander Graf 	u32 tdinit1	= (360 * CONFIG_DRAM_CLK) / 1000 + 1;	/* 360ns */
124*e6e505b9SAlexander Graf 	u32 tdinit2	= (200 * CONFIG_DRAM_CLK) + 1;		/* 200us */
125*e6e505b9SAlexander Graf 	u32 tdinit3	= (1 * CONFIG_DRAM_CLK) + 1;		/* 1us */
126*e6e505b9SAlexander Graf 
127*e6e505b9SAlexander Graf 	u8 twtp		= tcwl + 2 + twr;	/* WL + BL / 2 + tWR */
128*e6e505b9SAlexander Graf 	u8 twr2rd	= tcwl + 2 + twtr; 	/* WL + BL / 2 + tWTR */
129*e6e505b9SAlexander Graf 	u8 trd2wr	= tcl + 2 + 1 - tcwl; 	/* RL + BL / 2 + 2 - WL */
130*e6e505b9SAlexander Graf 
131*e6e505b9SAlexander Graf 	/* Set work mode register */
132*e6e505b9SAlexander Graf 	mctl_set_cr(para);
133*e6e505b9SAlexander Graf 	/* Set mode register */
134*e6e505b9SAlexander Graf 	writel(MCTL_MR0, &mctl_ctl->mr0);
135*e6e505b9SAlexander Graf 	writel(MCTL_MR1, &mctl_ctl->mr1);
136*e6e505b9SAlexander Graf 	writel(MCTL_MR2, &mctl_ctl->mr2);
137*e6e505b9SAlexander Graf 	writel(MCTL_MR3, &mctl_ctl->mr3);
138*e6e505b9SAlexander Graf 	/* Set dram timing */
139*e6e505b9SAlexander Graf 	reg_val = (twtp << 24) | (tfaw << 16) | (trasmax << 8) | (tras << 0);
140*e6e505b9SAlexander Graf 	writel(reg_val, &mctl_ctl->dramtmg0);
141*e6e505b9SAlexander Graf 	reg_val = (txp << 16) | (trtp << 8) | (trc << 0);
142*e6e505b9SAlexander Graf 	writel(reg_val, &mctl_ctl->dramtmg1);
143*e6e505b9SAlexander Graf 	reg_val = (tcwl << 24) | (tcl << 16) | (trd2wr << 8) | (twr2rd << 0);
144*e6e505b9SAlexander Graf 	writel(reg_val, &mctl_ctl->dramtmg2);
145*e6e505b9SAlexander Graf 	reg_val = (tmrw << 16) | (tmrd << 12) | (tmod << 0);
146*e6e505b9SAlexander Graf 	writel(reg_val, &mctl_ctl->dramtmg3);
147*e6e505b9SAlexander Graf 	reg_val = (trcd << 24) | (tccd << 16) | (trrd << 8) | (trp << 0);
148*e6e505b9SAlexander Graf 	writel(reg_val, &mctl_ctl->dramtmg4);
149*e6e505b9SAlexander Graf 	reg_val = (tcksrx << 24) | (tcksre << 16) | (tckesr << 8) | (tcke << 0);
150*e6e505b9SAlexander Graf 	writel(reg_val, &mctl_ctl->dramtmg5);
151*e6e505b9SAlexander Graf 	/* Set two rank timing and exit self-refresh timing */
152*e6e505b9SAlexander Graf 	reg_val = readl(&mctl_ctl->dramtmg8);
153*e6e505b9SAlexander Graf 	reg_val &= ~(0xff << 8);
154*e6e505b9SAlexander Graf 	reg_val &= ~(0xff << 0);
155*e6e505b9SAlexander Graf 	reg_val |= (0x33 << 8);
156*e6e505b9SAlexander Graf 	reg_val |= (0x8 << 0);
157*e6e505b9SAlexander Graf 	writel(reg_val, &mctl_ctl->dramtmg8);
158*e6e505b9SAlexander Graf 	/* Set phy interface time */
159*e6e505b9SAlexander Graf 	reg_val = (0x2 << 24) | (t_rdata_en << 16) | (0x1 << 8)
160*e6e505b9SAlexander Graf 			| (wr_latency << 0);
161*e6e505b9SAlexander Graf 	/* PHY interface write latency and read latency configure */
162*e6e505b9SAlexander Graf 	writel(reg_val, &mctl_ctl->pitmg0);
163*e6e505b9SAlexander Graf 	/* Set phy time  PTR0-2 use default */
164*e6e505b9SAlexander Graf 	writel(((tdinit0 << 0) | (tdinit1 << 20)), &mctl_ctl->ptr3);
165*e6e505b9SAlexander Graf 	writel(((tdinit2 << 0) | (tdinit3 << 20)), &mctl_ctl->ptr4);
166*e6e505b9SAlexander Graf 	/* Set refresh timing */
167*e6e505b9SAlexander Graf 	reg_val = (trefi << 16) | (trfc << 0);
168*e6e505b9SAlexander Graf 	writel(reg_val, &mctl_ctl->rfshtmg);
169*e6e505b9SAlexander Graf }
170*e6e505b9SAlexander Graf 
mctl_set_pir(u32 val)171*e6e505b9SAlexander Graf static void mctl_set_pir(u32 val)
172*e6e505b9SAlexander Graf {
173*e6e505b9SAlexander Graf 	struct sunxi_mctl_ctl_reg * const mctl_ctl =
174*e6e505b9SAlexander Graf 		(struct sunxi_mctl_ctl_reg *)SUNXI_DRAM_CTL0_BASE;
175*e6e505b9SAlexander Graf 
176*e6e505b9SAlexander Graf 	writel(val, &mctl_ctl->pir);
177*e6e505b9SAlexander Graf 	mctl_await_completion(&mctl_ctl->pgsr0, 0x1, 0x1);
178*e6e505b9SAlexander Graf }
179*e6e505b9SAlexander Graf 
mctl_data_train_cfg(struct dram_para * para)180*e6e505b9SAlexander Graf static void mctl_data_train_cfg(struct dram_para *para)
181*e6e505b9SAlexander Graf {
182*e6e505b9SAlexander Graf 	struct sunxi_mctl_ctl_reg * const mctl_ctl =
183*e6e505b9SAlexander Graf 		(struct sunxi_mctl_ctl_reg *)SUNXI_DRAM_CTL0_BASE;
184*e6e505b9SAlexander Graf 
185*e6e505b9SAlexander Graf 	if (para->rank == 2)
186*e6e505b9SAlexander Graf 		clrsetbits_le32(&mctl_ctl->dtcr, 0x3 << 24, 0x3 << 24);
187*e6e505b9SAlexander Graf 	else
188*e6e505b9SAlexander Graf 		clrsetbits_le32(&mctl_ctl->dtcr, 0x3 << 24, 0x1 << 24);
189*e6e505b9SAlexander Graf }
190*e6e505b9SAlexander Graf 
mctl_train_dram(struct dram_para * para)191*e6e505b9SAlexander Graf static int mctl_train_dram(struct dram_para *para)
192*e6e505b9SAlexander Graf {
193*e6e505b9SAlexander Graf 	struct sunxi_mctl_ctl_reg * const mctl_ctl =
194*e6e505b9SAlexander Graf 		(struct sunxi_mctl_ctl_reg *)SUNXI_DRAM_CTL0_BASE;
195*e6e505b9SAlexander Graf 
196*e6e505b9SAlexander Graf 	mctl_data_train_cfg(para);
197*e6e505b9SAlexander Graf 	mctl_set_pir(0x5f3);
198*e6e505b9SAlexander Graf 
199*e6e505b9SAlexander Graf 	return ((readl(&mctl_ctl->pgsr0) >> 20) & 0xff) ? -EIO : 0;
200*e6e505b9SAlexander Graf }
201*e6e505b9SAlexander Graf 
mctl_channel_init(struct dram_para * para)202*e6e505b9SAlexander Graf static int mctl_channel_init(struct dram_para *para)
203*e6e505b9SAlexander Graf {
204*e6e505b9SAlexander Graf 	struct sunxi_mctl_ctl_reg * const mctl_ctl =
205*e6e505b9SAlexander Graf 		(struct sunxi_mctl_ctl_reg *)SUNXI_DRAM_CTL0_BASE;
206*e6e505b9SAlexander Graf 	struct sunxi_mctl_com_reg * const mctl_com =
207*e6e505b9SAlexander Graf 		(struct sunxi_mctl_com_reg *)SUNXI_DRAM_COM_BASE;
208*e6e505b9SAlexander Graf 	u32 low_data_lines_status;  /* Training status of datalines 0 - 7 */
209*e6e505b9SAlexander Graf 	u32 high_data_lines_status; /* Training status of datalines 8 - 15 */
210*e6e505b9SAlexander Graf 
211*e6e505b9SAlexander Graf 	auto_set_timing_para(para);
212*e6e505b9SAlexander Graf 
213*e6e505b9SAlexander Graf 	/* Disable dram VTC */
214*e6e505b9SAlexander Graf 	clrbits_le32(&mctl_ctl->pgcr0, 0x3f << 0);
215*e6e505b9SAlexander Graf 
216*e6e505b9SAlexander Graf 	/* Set ODT */
217*e6e505b9SAlexander Graf 	if ((CONFIG_DRAM_CLK > 400) && IS_ENABLED(CONFIG_DRAM_ODT_EN)) {
218*e6e505b9SAlexander Graf 		setbits_le32(DXnGCR0(0), 0x3 << 9);
219*e6e505b9SAlexander Graf 		setbits_le32(DXnGCR0(1), 0x3 << 9);
220*e6e505b9SAlexander Graf 	} else {
221*e6e505b9SAlexander Graf 		clrbits_le32(DXnGCR0(0), 0x3 << 9);
222*e6e505b9SAlexander Graf 		clrbits_le32(DXnGCR0(1), 0x3 << 9);
223*e6e505b9SAlexander Graf 	}
224*e6e505b9SAlexander Graf 
225*e6e505b9SAlexander Graf 	/* set PLL configuration */
226*e6e505b9SAlexander Graf 	if (CONFIG_DRAM_CLK >= 480)
227*e6e505b9SAlexander Graf 		setbits_le32(&mctl_ctl->pllgcr, 0x1 << 18);
228*e6e505b9SAlexander Graf 	else
229*e6e505b9SAlexander Graf 		setbits_le32(&mctl_ctl->pllgcr, 0x3 << 18);
230*e6e505b9SAlexander Graf 
231*e6e505b9SAlexander Graf 	/* Auto detect dram config, set 2 rank and 16bit bus-width */
232*e6e505b9SAlexander Graf 	para->cs1 = 0;
233*e6e505b9SAlexander Graf 	para->rank = 2;
234*e6e505b9SAlexander Graf 	para->bus_width = 16;
235*e6e505b9SAlexander Graf 	mctl_set_cr(para);
236*e6e505b9SAlexander Graf 
237*e6e505b9SAlexander Graf 	/* Open DQS gating */
238*e6e505b9SAlexander Graf 	clrbits_le32(&mctl_ctl->pgcr2, (0x3 << 6));
239*e6e505b9SAlexander Graf 	clrbits_le32(&mctl_ctl->dqsgmr, (0x1 << 8) | (0x7));
240*e6e505b9SAlexander Graf 
241*e6e505b9SAlexander Graf 	mctl_data_train_cfg(para);
242*e6e505b9SAlexander Graf 
243*e6e505b9SAlexander Graf 	/* ZQ calibration */
244*e6e505b9SAlexander Graf 	writel(CONFIG_DRAM_ZQ & 0xff, &mctl_ctl->zqcr1);
245*e6e505b9SAlexander Graf 	/* CA calibration */
246*e6e505b9SAlexander Graf 	mctl_set_pir(0x00000003);
247*e6e505b9SAlexander Graf 	/* More ZQ calibration */
248*e6e505b9SAlexander Graf 	writel(readl(&mctl_ctl->zqsr0) | 0x10000000, &mctl_ctl->zqcr2);
249*e6e505b9SAlexander Graf 	writel((CONFIG_DRAM_ZQ >> 8) & 0xff, &mctl_ctl->zqcr1);
250*e6e505b9SAlexander Graf 
251*e6e505b9SAlexander Graf 	/* DQS gate training */
252*e6e505b9SAlexander Graf 	if (mctl_train_dram(para) != 0) {
253*e6e505b9SAlexander Graf 		low_data_lines_status  = (readl(DXnGSR0(0)) >> 24) & 0x03;
254*e6e505b9SAlexander Graf 		high_data_lines_status = (readl(DXnGSR0(1)) >> 24) & 0x03;
255*e6e505b9SAlexander Graf 
256*e6e505b9SAlexander Graf 		if (low_data_lines_status == 0x3)
257*e6e505b9SAlexander Graf 			return -EIO;
258*e6e505b9SAlexander Graf 
259*e6e505b9SAlexander Graf 		/* DRAM has only one rank */
260*e6e505b9SAlexander Graf 		para->rank = 1;
261*e6e505b9SAlexander Graf 		mctl_set_cr(para);
262*e6e505b9SAlexander Graf 
263*e6e505b9SAlexander Graf 		if (low_data_lines_status == high_data_lines_status)
264*e6e505b9SAlexander Graf 			goto done; /* 16 bit bus, 1 rank */
265*e6e505b9SAlexander Graf 
266*e6e505b9SAlexander Graf 		if (!(low_data_lines_status & high_data_lines_status)) {
267*e6e505b9SAlexander Graf 			/* Retry 16 bit bus-width with CS1 set */
268*e6e505b9SAlexander Graf 			para->cs1 = 1;
269*e6e505b9SAlexander Graf 			mctl_set_cr(para);
270*e6e505b9SAlexander Graf 			if (mctl_train_dram(para) == 0)
271*e6e505b9SAlexander Graf 				goto done;
272*e6e505b9SAlexander Graf 		}
273*e6e505b9SAlexander Graf 
274*e6e505b9SAlexander Graf 		/* Try 8 bit bus-width */
275*e6e505b9SAlexander Graf 		writel(0x0, DXnGCR0(1)); /* Disable high DQ */
276*e6e505b9SAlexander Graf 		para->cs1 = 0;
277*e6e505b9SAlexander Graf 		para->bus_width = 8;
278*e6e505b9SAlexander Graf 		mctl_set_cr(para);
279*e6e505b9SAlexander Graf 		if (mctl_train_dram(para) != 0)
280*e6e505b9SAlexander Graf 			return -EIO;
281*e6e505b9SAlexander Graf 	}
282*e6e505b9SAlexander Graf done:
283*e6e505b9SAlexander Graf 	/* Check the dramc status */
284*e6e505b9SAlexander Graf 	mctl_await_completion(&mctl_ctl->statr, 0x1, 0x1);
285*e6e505b9SAlexander Graf 
286*e6e505b9SAlexander Graf 	/* Close DQS gating */
287*e6e505b9SAlexander Graf 	setbits_le32(&mctl_ctl->pgcr2, 0x3 << 6);
288*e6e505b9SAlexander Graf 
289*e6e505b9SAlexander Graf 	/* Enable master access */
290*e6e505b9SAlexander Graf 	writel(0xffffffff, &mctl_com->maer);
291*e6e505b9SAlexander Graf 
292*e6e505b9SAlexander Graf 	return 0;
293*e6e505b9SAlexander Graf }
294*e6e505b9SAlexander Graf 
mctl_sys_init(struct dram_para * para)295*e6e505b9SAlexander Graf static void mctl_sys_init(struct dram_para *para)
296*e6e505b9SAlexander Graf {
297*e6e505b9SAlexander Graf 	struct sunxi_ccm_reg * const ccm =
298*e6e505b9SAlexander Graf 			(struct sunxi_ccm_reg *)SUNXI_CCM_BASE;
299*e6e505b9SAlexander Graf 	struct sunxi_mctl_ctl_reg * const mctl_ctl =
300*e6e505b9SAlexander Graf 			(struct sunxi_mctl_ctl_reg *)SUNXI_DRAM_CTL0_BASE;
301*e6e505b9SAlexander Graf 	struct sunxi_mctl_com_reg * const mctl_com =
302*e6e505b9SAlexander Graf 			(struct sunxi_mctl_com_reg *)SUNXI_DRAM_COM_BASE;
303*e6e505b9SAlexander Graf 
304*e6e505b9SAlexander Graf 	clrsetbits_le32(&ccm->dram_pll_cfg, CCM_DRAMPLL_CFG_SRC_MASK,
305*e6e505b9SAlexander Graf 			CCM_DRAMPLL_CFG_SRC_PLL11);
306*e6e505b9SAlexander Graf 
307*e6e505b9SAlexander Graf 	clock_set_pll11(CONFIG_DRAM_CLK * 1000000 * DRAM_CLK_MUL,
308*e6e505b9SAlexander Graf 			DRAM_SIGMA_DELTA_ENABLE);
309*e6e505b9SAlexander Graf 
310*e6e505b9SAlexander Graf 	clrsetbits_le32(&ccm->dram_clk_cfg, CCM_DRAMCLK_CFG_DIV_MASK,
311*e6e505b9SAlexander Graf 			CCM_DRAMCLK_CFG_DIV(DRAM_CLK_DIV) |
312*e6e505b9SAlexander Graf 			CCM_DRAMCLK_CFG_RST | CCM_DRAMCLK_CFG_UPD);
313*e6e505b9SAlexander Graf 	mctl_await_completion(&ccm->dram_clk_cfg, CCM_DRAMCLK_CFG_UPD, 0);
314*e6e505b9SAlexander Graf 
315*e6e505b9SAlexander Graf 	setbits_le32(&ccm->ahb_reset0_cfg, 1 << AHB_RESET_OFFSET_MCTL);
316*e6e505b9SAlexander Graf 	setbits_le32(&ccm->ahb_gate0, 1 << AHB_GATE_OFFSET_MCTL);
317*e6e505b9SAlexander Graf 	setbits_le32(&ccm->mbus_reset, CCM_MBUS_RESET_RESET);
318*e6e505b9SAlexander Graf 	setbits_le32(&ccm->mbus0_clk_cfg, MBUS_CLK_GATE);
319*e6e505b9SAlexander Graf 
320*e6e505b9SAlexander Graf 	/* Set dram master access priority */
321*e6e505b9SAlexander Graf 	writel(0x0, &mctl_com->mapr);
322*e6e505b9SAlexander Graf 	writel(0x0f802f01, &mctl_ctl->sched);
323*e6e505b9SAlexander Graf 	writel(0x0000400f, &mctl_ctl->clken);	/* normal */
324*e6e505b9SAlexander Graf 
325*e6e505b9SAlexander Graf 	udelay(250);
326*e6e505b9SAlexander Graf }
327*e6e505b9SAlexander Graf 
sunxi_dram_init(void)328*e6e505b9SAlexander Graf unsigned long sunxi_dram_init(void)
329*e6e505b9SAlexander Graf {
330*e6e505b9SAlexander Graf 	struct sunxi_mctl_com_reg * const mctl_com =
331*e6e505b9SAlexander Graf 			(struct sunxi_mctl_com_reg *)SUNXI_DRAM_COM_BASE;
332*e6e505b9SAlexander Graf 	struct sunxi_mctl_ctl_reg * const mctl_ctl =
333*e6e505b9SAlexander Graf 			(struct sunxi_mctl_ctl_reg *)SUNXI_DRAM_CTL0_BASE;
334*e6e505b9SAlexander Graf 
335*e6e505b9SAlexander Graf 	struct dram_para para = {
336*e6e505b9SAlexander Graf 		.cs1 = 0,
337*e6e505b9SAlexander Graf 		.bank = 1,
338*e6e505b9SAlexander Graf 		.rank = 1,
339*e6e505b9SAlexander Graf 		.rows = 15,
340*e6e505b9SAlexander Graf 		.bus_width = 16,
341*e6e505b9SAlexander Graf 		.page_size = 2048,
342*e6e505b9SAlexander Graf 	};
343*e6e505b9SAlexander Graf 
344*e6e505b9SAlexander Graf 	mctl_sys_init(&para);
345*e6e505b9SAlexander Graf 
346*e6e505b9SAlexander Graf 	if (mctl_channel_init(&para) != 0)
347*e6e505b9SAlexander Graf 		return 0;
348*e6e505b9SAlexander Graf 
349*e6e505b9SAlexander Graf 	auto_detect_dram_size(&para);
350*e6e505b9SAlexander Graf 
351*e6e505b9SAlexander Graf 	/* Enable master software clk */
352*e6e505b9SAlexander Graf 	writel(readl(&mctl_com->swonr) | 0x3ffff, &mctl_com->swonr);
353*e6e505b9SAlexander Graf 
354*e6e505b9SAlexander Graf 	/* Set DRAM ODT MAP */
355*e6e505b9SAlexander Graf 	if (para.rank == 2)
356*e6e505b9SAlexander Graf 		writel(0x00000303, &mctl_ctl->odtmap);
357*e6e505b9SAlexander Graf 	else
358*e6e505b9SAlexander Graf 		writel(0x00000201, &mctl_ctl->odtmap);
359*e6e505b9SAlexander Graf 
360*e6e505b9SAlexander Graf 	return para.page_size * (para.bus_width / 8) *
361*e6e505b9SAlexander Graf 		(1 << (para.bank + para.rank + para.rows));
362*e6e505b9SAlexander Graf }
363