1 // SPDX-License-Identifier: GPL-2.0+
2 #include <asm/arch/ps7_init_gpl.h>
3 
4 unsigned long ps7_pll_init_data_3_0[] = {
5 	EMIT_WRITE(0XF8000008, 0x0000DF0DU),
6 	EMIT_MASKWRITE(0XF8000110, 0x003FFFF0U, 0x000FA240U),
7 	EMIT_MASKWRITE(0XF8000100, 0x0007F000U, 0x0003C000U),
8 	EMIT_MASKWRITE(0XF8000100, 0x00000010U, 0x00000010U),
9 	EMIT_MASKWRITE(0XF8000100, 0x00000001U, 0x00000001U),
10 	EMIT_MASKWRITE(0XF8000100, 0x00000001U, 0x00000000U),
11 	EMIT_MASKPOLL(0XF800010C, 0x00000001U),
12 	EMIT_MASKWRITE(0XF8000100, 0x00000010U, 0x00000000U),
13 	EMIT_MASKWRITE(0XF8000120, 0x1F003F30U, 0x1F000300U),
14 	EMIT_MASKWRITE(0XF8000114, 0x003FFFF0U, 0x0012C220U),
15 	EMIT_MASKWRITE(0XF8000104, 0x0007F000U, 0x00020000U),
16 	EMIT_MASKWRITE(0XF8000104, 0x00000010U, 0x00000010U),
17 	EMIT_MASKWRITE(0XF8000104, 0x00000001U, 0x00000001U),
18 	EMIT_MASKWRITE(0XF8000104, 0x00000001U, 0x00000000U),
19 	EMIT_MASKPOLL(0XF800010C, 0x00000002U),
20 	EMIT_MASKWRITE(0XF8000104, 0x00000010U, 0x00000000U),
21 	EMIT_MASKWRITE(0XF8000124, 0xFFF00003U, 0x0C200003U),
22 	EMIT_MASKWRITE(0XF8000118, 0x003FFFF0U, 0x000FA240U),
23 	EMIT_MASKWRITE(0XF8000108, 0x0007F000U, 0x0003C000U),
24 	EMIT_MASKWRITE(0XF8000108, 0x00000010U, 0x00000010U),
25 	EMIT_MASKWRITE(0XF8000108, 0x00000001U, 0x00000001U),
26 	EMIT_MASKWRITE(0XF8000108, 0x00000001U, 0x00000000U),
27 	EMIT_MASKPOLL(0XF800010C, 0x00000004U),
28 	EMIT_MASKWRITE(0XF8000108, 0x00000010U, 0x00000000U),
29 	EMIT_WRITE(0XF8000004, 0x0000767BU),
30 	EMIT_EXIT(),
31 };
32 
33 unsigned long ps7_clock_init_data_3_0[] = {
34 	EMIT_WRITE(0XF8000008, 0x0000DF0DU),
35 	EMIT_MASKWRITE(0XF8000128, 0x03F03F01U, 0x00700F01U),
36 	EMIT_MASKWRITE(0XF8000138, 0x00000011U, 0x00000001U),
37 	EMIT_MASKWRITE(0XF8000140, 0x03F03F71U, 0x00101001U),
38 	EMIT_MASKWRITE(0XF800014C, 0x00003F31U, 0x00000A01U),
39 	EMIT_MASKWRITE(0XF8000150, 0x00003F33U, 0x00001401U),
40 	EMIT_MASKWRITE(0XF8000154, 0x00003F33U, 0x00001401U),
41 	EMIT_MASKWRITE(0XF8000158, 0x00003F33U, 0x00000A02U),
42 	EMIT_MASKWRITE(0XF800015C, 0x03F03F33U, 0x00A01901U),
43 	EMIT_MASKWRITE(0XF8000160, 0x007F007FU, 0x00000000U),
44 	EMIT_MASKWRITE(0XF8000168, 0x00003F31U, 0x00000A01U),
45 	EMIT_MASKWRITE(0XF8000170, 0x03F03F30U, 0x00500800U),
46 	EMIT_MASKWRITE(0XF80001C4, 0x00000001U, 0x00000001U),
47 	EMIT_MASKWRITE(0XF800012C, 0x01FFCCCDU, 0x01DD844DU),
48 	EMIT_WRITE(0XF8000004, 0x0000767BU),
49 	EMIT_EXIT(),
50 };
51 
52 unsigned long ps7_ddr_init_data_3_0[] = {
53 	EMIT_MASKWRITE(0XF8006000, 0x0001FFFFU, 0x00000084U),
54 	EMIT_MASKWRITE(0XF8006004, 0x0007FFFFU, 0x00001040U),
55 	EMIT_MASKWRITE(0XF8006008, 0x03FFFFFFU, 0x03C0780FU),
56 	EMIT_MASKWRITE(0XF800600C, 0x03FFFFFFU, 0x02001001U),
57 	EMIT_MASKWRITE(0XF8006010, 0x03FFFFFFU, 0x00014001U),
58 	EMIT_MASKWRITE(0XF8006014, 0x001FFFFFU, 0x00040EDAU),
59 	EMIT_MASKWRITE(0XF8006018, 0xF7FFFFFFU, 0x44D258D4U),
60 	EMIT_MASKWRITE(0XF800601C, 0xFFFFFFFFU, 0xB2024127U),
61 	EMIT_MASKWRITE(0XF8006020, 0x7FDFFFFCU, 0x2B08B290U),
62 	EMIT_MASKWRITE(0XF8006024, 0x0FFFFFC3U, 0x00000000U),
63 	EMIT_MASKWRITE(0XF8006028, 0x00003FFFU, 0x00002007U),
64 	EMIT_MASKWRITE(0XF800602C, 0xFFFFFFFFU, 0x00000018U),
65 	EMIT_MASKWRITE(0XF8006030, 0xFFFFFFFFU, 0x00040970U),
66 	EMIT_MASKWRITE(0XF8006034, 0x13FF3FFFU, 0x000116D4U),
67 	EMIT_MASKWRITE(0XF8006038, 0x00000003U, 0x00000000U),
68 	EMIT_MASKWRITE(0XF800603C, 0x000FFFFFU, 0x00000666U),
69 	EMIT_MASKWRITE(0XF8006040, 0xFFFFFFFFU, 0xFFFF0000U),
70 	EMIT_MASKWRITE(0XF8006044, 0x0FFFFFFFU, 0x0FFF5555U),
71 	EMIT_MASKWRITE(0XF8006048, 0x0003F03FU, 0x0003C008U),
72 	EMIT_MASKWRITE(0XF8006050, 0xFF0F8FFFU, 0x77010800U),
73 	EMIT_MASKWRITE(0XF8006058, 0x00010000U, 0x00000000U),
74 	EMIT_MASKWRITE(0XF800605C, 0x0000FFFFU, 0x00005003U),
75 	EMIT_MASKWRITE(0XF8006060, 0x000017FFU, 0x0000003EU),
76 	EMIT_MASKWRITE(0XF8006064, 0x00021FE0U, 0x00020000U),
77 	EMIT_MASKWRITE(0XF8006068, 0x03FFFFFFU, 0x00284545U),
78 	EMIT_MASKWRITE(0XF800606C, 0x0000FFFFU, 0x00001610U),
79 	EMIT_MASKWRITE(0XF8006078, 0x03FFFFFFU, 0x00466111U),
80 	EMIT_MASKWRITE(0XF800607C, 0x000FFFFFU, 0x00032222U),
81 	EMIT_MASKWRITE(0XF80060A4, 0xFFFFFFFFU, 0x10200802U),
82 	EMIT_MASKWRITE(0XF80060A8, 0x0FFFFFFFU, 0x0690CB73U),
83 	EMIT_MASKWRITE(0XF80060AC, 0x000001FFU, 0x000001FEU),
84 	EMIT_MASKWRITE(0XF80060B0, 0x1FFFFFFFU, 0x1CFFFFFFU),
85 	EMIT_MASKWRITE(0XF80060B4, 0x00000200U, 0x00000200U),
86 	EMIT_MASKWRITE(0XF80060B8, 0x01FFFFFFU, 0x0020006AU),
87 	EMIT_MASKWRITE(0XF80060C4, 0x00000003U, 0x00000000U),
88 	EMIT_MASKWRITE(0XF80060C8, 0x000000FFU, 0x00000000U),
89 	EMIT_MASKWRITE(0XF80060DC, 0x00000001U, 0x00000000U),
90 	EMIT_MASKWRITE(0XF80060F0, 0x0000FFFFU, 0x00000000U),
91 	EMIT_MASKWRITE(0XF80060F4, 0x0000000FU, 0x00000008U),
92 	EMIT_MASKWRITE(0XF8006114, 0x000000FFU, 0x00000000U),
93 	EMIT_MASKWRITE(0XF8006118, 0x7FFFFFCFU, 0x40000001U),
94 	EMIT_MASKWRITE(0XF800611C, 0x7FFFFFCFU, 0x40000001U),
95 	EMIT_MASKWRITE(0XF8006120, 0x7FFFFFCFU, 0x40000000U),
96 	EMIT_MASKWRITE(0XF8006124, 0x7FFFFFCFU, 0x40000000U),
97 	EMIT_MASKWRITE(0XF800612C, 0x000FFFFFU, 0x0001D400U),
98 	EMIT_MASKWRITE(0XF8006130, 0x000FFFFFU, 0x0001C400U),
99 	EMIT_MASKWRITE(0XF8006134, 0x000FFFFFU, 0x0001BC00U),
100 	EMIT_MASKWRITE(0XF8006138, 0x000FFFFFU, 0x0001C800U),
101 	EMIT_MASKWRITE(0XF8006140, 0x000FFFFFU, 0x00000035U),
102 	EMIT_MASKWRITE(0XF8006144, 0x000FFFFFU, 0x00000035U),
103 	EMIT_MASKWRITE(0XF8006148, 0x000FFFFFU, 0x00000035U),
104 	EMIT_MASKWRITE(0XF800614C, 0x000FFFFFU, 0x00000035U),
105 	EMIT_MASKWRITE(0XF8006154, 0x000FFFFFU, 0x0000007AU),
106 	EMIT_MASKWRITE(0XF8006158, 0x000FFFFFU, 0x0000007DU),
107 	EMIT_MASKWRITE(0XF800615C, 0x000FFFFFU, 0x00000080U),
108 	EMIT_MASKWRITE(0XF8006160, 0x000FFFFFU, 0x0000007EU),
109 	EMIT_MASKWRITE(0XF8006168, 0x001FFFFFU, 0x000000CAU),
110 	EMIT_MASKWRITE(0XF800616C, 0x001FFFFFU, 0x000000C6U),
111 	EMIT_MASKWRITE(0XF8006170, 0x001FFFFFU, 0x000000C4U),
112 	EMIT_MASKWRITE(0XF8006174, 0x001FFFFFU, 0x000000C7U),
113 	EMIT_MASKWRITE(0XF800617C, 0x000FFFFFU, 0x000000BAU),
114 	EMIT_MASKWRITE(0XF8006180, 0x000FFFFFU, 0x000000BDU),
115 	EMIT_MASKWRITE(0XF8006184, 0x000FFFFFU, 0x000000C0U),
116 	EMIT_MASKWRITE(0XF8006188, 0x000FFFFFU, 0x000000BEU),
117 	EMIT_MASKWRITE(0XF8006190, 0x6FFFFEFEU, 0x00040080U),
118 	EMIT_MASKWRITE(0XF8006194, 0x000FFFFFU, 0x0001FD04U),
119 	EMIT_MASKWRITE(0XF8006204, 0xFFFFFFFFU, 0x00000000U),
120 	EMIT_MASKWRITE(0XF8006208, 0x000703FFU, 0x000003FFU),
121 	EMIT_MASKWRITE(0XF800620C, 0x000703FFU, 0x000003FFU),
122 	EMIT_MASKWRITE(0XF8006210, 0x000703FFU, 0x000003FFU),
123 	EMIT_MASKWRITE(0XF8006214, 0x000703FFU, 0x000003FFU),
124 	EMIT_MASKWRITE(0XF8006218, 0x000F03FFU, 0x000003FFU),
125 	EMIT_MASKWRITE(0XF800621C, 0x000F03FFU, 0x000003FFU),
126 	EMIT_MASKWRITE(0XF8006220, 0x000F03FFU, 0x000003FFU),
127 	EMIT_MASKWRITE(0XF8006224, 0x000F03FFU, 0x000003FFU),
128 	EMIT_MASKWRITE(0XF80062A8, 0x00000FF5U, 0x00000000U),
129 	EMIT_MASKWRITE(0XF80062AC, 0xFFFFFFFFU, 0x00000000U),
130 	EMIT_MASKWRITE(0XF80062B0, 0x003FFFFFU, 0x00005125U),
131 	EMIT_MASKWRITE(0XF80062B4, 0x0003FFFFU, 0x000012A8U),
132 	EMIT_MASKPOLL(0XF8000B74, 0x00002000U),
133 	EMIT_MASKWRITE(0XF8006000, 0x0001FFFFU, 0x00000085U),
134 	EMIT_MASKPOLL(0XF8006054, 0x00000007U),
135 	EMIT_EXIT(),
136 };
137 
138 unsigned long ps7_mio_init_data_3_0[] = {
139 	EMIT_WRITE(0XF8000008, 0x0000DF0DU),
140 	EMIT_MASKWRITE(0XF8000B40, 0x00000FFFU, 0x00000600U),
141 	EMIT_MASKWRITE(0XF8000B44, 0x00000FFFU, 0x00000600U),
142 	EMIT_MASKWRITE(0XF8000B48, 0x00000FFFU, 0x00000672U),
143 	EMIT_MASKWRITE(0XF8000B4C, 0x00000FFFU, 0x00000800U),
144 	EMIT_MASKWRITE(0XF8000B50, 0x00000FFFU, 0x00000674U),
145 	EMIT_MASKWRITE(0XF8000B54, 0x00000FFFU, 0x00000800U),
146 	EMIT_MASKWRITE(0XF8000B58, 0x00000FFFU, 0x00000600U),
147 	EMIT_MASKWRITE(0XF8000B5C, 0xFFFFFFFFU, 0x0018C068U),
148 	EMIT_MASKWRITE(0XF8000B60, 0xFFFFFFFFU, 0x00F98068U),
149 	EMIT_MASKWRITE(0XF8000B64, 0xFFFFFFFFU, 0x00F98068U),
150 	EMIT_MASKWRITE(0XF8000B68, 0xFFFFFFFFU, 0x00F98068U),
151 	EMIT_MASKWRITE(0XF8000B6C, 0x00007FFFU, 0x00000220U),
152 	EMIT_MASKWRITE(0XF8000B70, 0x00000001U, 0x00000001U),
153 	EMIT_MASKWRITE(0XF8000B70, 0x00000021U, 0x00000020U),
154 	EMIT_MASKWRITE(0XF8000B70, 0x07FEFFFFU, 0x00000823U),
155 	EMIT_MASKWRITE(0XF8000700, 0x00003FFFU, 0x00000700U),
156 	EMIT_MASKWRITE(0XF8000704, 0x00003FFFU, 0x00000702U),
157 	EMIT_MASKWRITE(0XF8000708, 0x00003FFFU, 0x00000702U),
158 	EMIT_MASKWRITE(0XF800070C, 0x00003FFFU, 0x00000702U),
159 	EMIT_MASKWRITE(0XF8000710, 0x00003FFFU, 0x00000702U),
160 	EMIT_MASKWRITE(0XF8000714, 0x00003FFFU, 0x00000702U),
161 	EMIT_MASKWRITE(0XF8000718, 0x00003FFFU, 0x00000702U),
162 	EMIT_MASKWRITE(0XF800071C, 0x00003FFFU, 0x00000700U),
163 	EMIT_MASKWRITE(0XF8000720, 0x00003FFFU, 0x00000702U),
164 	EMIT_MASKWRITE(0XF8000724, 0x00003FFFU, 0x00000700U),
165 	EMIT_MASKWRITE(0XF8000728, 0x00003FFFU, 0x000007A0U),
166 	EMIT_MASKWRITE(0XF800072C, 0x00003FFFU, 0x000007A0U),
167 	EMIT_MASKWRITE(0XF8000730, 0x00003FFFU, 0x000007A0U),
168 	EMIT_MASKWRITE(0XF8000734, 0x00003FFFU, 0x000007A0U),
169 	EMIT_MASKWRITE(0XF8000738, 0x00003FFFU, 0x00000740U),
170 	EMIT_MASKWRITE(0XF800073C, 0x00003FFFU, 0x00000740U),
171 	EMIT_MASKWRITE(0XF8000740, 0x00003FFFU, 0x00000302U),
172 	EMIT_MASKWRITE(0XF8000744, 0x00003FFFU, 0x00000302U),
173 	EMIT_MASKWRITE(0XF8000748, 0x00003FFFU, 0x00000302U),
174 	EMIT_MASKWRITE(0XF800074C, 0x00003FFFU, 0x00000302U),
175 	EMIT_MASKWRITE(0XF8000750, 0x00003FFFU, 0x00000302U),
176 	EMIT_MASKWRITE(0XF8000754, 0x00003FFFU, 0x00000302U),
177 	EMIT_MASKWRITE(0XF8000758, 0x00003FFFU, 0x00000303U),
178 	EMIT_MASKWRITE(0XF800075C, 0x00003FFFU, 0x00000303U),
179 	EMIT_MASKWRITE(0XF8000760, 0x00003FFFU, 0x00000303U),
180 	EMIT_MASKWRITE(0XF8000764, 0x00003FFFU, 0x00000303U),
181 	EMIT_MASKWRITE(0XF8000768, 0x00003FFFU, 0x00000303U),
182 	EMIT_MASKWRITE(0XF800076C, 0x00003FFFU, 0x00000303U),
183 	EMIT_MASKWRITE(0XF8000770, 0x00003FFFU, 0x00000204U),
184 	EMIT_MASKWRITE(0XF8000774, 0x00003FFFU, 0x00000205U),
185 	EMIT_MASKWRITE(0XF8000778, 0x00003FFFU, 0x00000204U),
186 	EMIT_MASKWRITE(0XF800077C, 0x00003FFFU, 0x00000205U),
187 	EMIT_MASKWRITE(0XF8000780, 0x00003FFFU, 0x00000204U),
188 	EMIT_MASKWRITE(0XF8000784, 0x00003FFFU, 0x00000204U),
189 	EMIT_MASKWRITE(0XF8000788, 0x00003FFFU, 0x00000204U),
190 	EMIT_MASKWRITE(0XF800078C, 0x00003FFFU, 0x00000204U),
191 	EMIT_MASKWRITE(0XF8000790, 0x00003FFFU, 0x00000205U),
192 	EMIT_MASKWRITE(0XF8000794, 0x00003FFFU, 0x00000204U),
193 	EMIT_MASKWRITE(0XF8000798, 0x00003FFFU, 0x00000204U),
194 	EMIT_MASKWRITE(0XF800079C, 0x00003FFFU, 0x00000204U),
195 	EMIT_MASKWRITE(0XF80007A0, 0x00003FFFU, 0x00000380U),
196 	EMIT_MASKWRITE(0XF80007A4, 0x00003FFFU, 0x00000380U),
197 	EMIT_MASKWRITE(0XF80007A8, 0x00003FFFU, 0x00000380U),
198 	EMIT_MASKWRITE(0XF80007AC, 0x00003FFFU, 0x00000380U),
199 	EMIT_MASKWRITE(0XF80007B0, 0x00003FFFU, 0x00000380U),
200 	EMIT_MASKWRITE(0XF80007B4, 0x00003FFFU, 0x00000380U),
201 	EMIT_MASKWRITE(0XF80007B8, 0x00003FFFU, 0x00000361U),
202 	EMIT_MASKWRITE(0XF80007BC, 0x00003FFFU, 0x00000360U),
203 	EMIT_MASKWRITE(0XF80007C0, 0x00003FFFU, 0x00000361U),
204 	EMIT_MASKWRITE(0XF80007C4, 0x00003FFFU, 0x00000361U),
205 	EMIT_MASKWRITE(0XF80007C8, 0x00003FFFU, 0x000012E1U),
206 	EMIT_MASKWRITE(0XF80007CC, 0x00003FFFU, 0x000002E0U),
207 	EMIT_MASKWRITE(0XF80007D0, 0x00003FFFU, 0x00000380U),
208 	EMIT_MASKWRITE(0XF80007D4, 0x00003FFFU, 0x00000380U),
209 	EMIT_MASKWRITE(0XF8000830, 0x003F003FU, 0x00380037U),
210 	EMIT_WRITE(0XF8000004, 0x0000767BU),
211 	EMIT_EXIT(),
212 };
213 
214 unsigned long ps7_peripherals_init_data_3_0[] = {
215 	EMIT_WRITE(0XF8000008, 0x0000DF0DU),
216 	EMIT_MASKWRITE(0XF8000B48, 0x00000180U, 0x00000180U),
217 	EMIT_MASKWRITE(0XF8000B4C, 0x00000180U, 0x00000000U),
218 	EMIT_MASKWRITE(0XF8000B50, 0x00000180U, 0x00000180U),
219 	EMIT_MASKWRITE(0XF8000B54, 0x00000180U, 0x00000000U),
220 	EMIT_WRITE(0XF8000004, 0x0000767BU),
221 	EMIT_MASKWRITE(0XE0000034, 0x000000FFU, 0x00000006U),
222 	EMIT_MASKWRITE(0XE0000018, 0x0000FFFFU, 0x0000007CU),
223 	EMIT_MASKWRITE(0XE0000000, 0x000001FFU, 0x00000017U),
224 	EMIT_MASKWRITE(0XE0000004, 0x000003FFU, 0x00000020U),
225 	EMIT_MASKWRITE(0XE000D000, 0x00080000U, 0x00080000U),
226 	EMIT_MASKWRITE(0XF8007000, 0x20000000U, 0x00000000U),
227 	EMIT_MASKDELAY(0XF8F00200, 1),
228 	EMIT_MASKDELAY(0XF8F00200, 1),
229 	EMIT_MASKDELAY(0XF8F00200, 1),
230 	EMIT_MASKDELAY(0XF8F00200, 1),
231 	EMIT_MASKDELAY(0XF8F00200, 1),
232 	EMIT_MASKDELAY(0XF8F00200, 1),
233 	EMIT_EXIT(),
234 };
235 
236 unsigned long ps7_post_config_3_0[] = {
237 	EMIT_WRITE(0XF8000008, 0x0000DF0DU),
238 	EMIT_MASKWRITE(0XF8000900, 0x0000000FU, 0x0000000FU),
239 	EMIT_MASKWRITE(0XF8000240, 0xFFFFFFFFU, 0x00000000U),
240 	EMIT_WRITE(0XF8000004, 0x0000767BU),
241 	EMIT_EXIT(),
242 };
243 
ps7_post_config(void)244 int ps7_post_config(void)
245 {
246 	return ps7_config(ps7_post_config_3_0);
247 }
248 
ps7_init(void)249 int ps7_init(void)
250 {
251 	int ret;
252 
253 	ret = ps7_config(ps7_mio_init_data_3_0);
254 	if (ret != PS7_INIT_SUCCESS)
255 		return ret;
256 
257 	ret = ps7_config(ps7_pll_init_data_3_0);
258 	if (ret != PS7_INIT_SUCCESS)
259 		return ret;
260 
261 	ret = ps7_config(ps7_clock_init_data_3_0);
262 	if (ret != PS7_INIT_SUCCESS)
263 		return ret;
264 
265 	ret = ps7_config(ps7_ddr_init_data_3_0);
266 	if (ret != PS7_INIT_SUCCESS)
267 		return ret;
268 
269 	ret = ps7_config(ps7_peripherals_init_data_3_0);
270 	if (ret != PS7_INIT_SUCCESS)
271 		return ret;
272 
273 	return PS7_INIT_SUCCESS;
274 }
275