1 // SPDX-License-Identifier: GPL-2.0+
2 /*
3 * Copyright (c) Xilinx, Inc.
4 */
5
6 #include <asm/arch/ps7_init_gpl.h>
7
8 static unsigned long ps7_pll_init_data[] = {
9 EMIT_WRITE(0xF8000008, 0x0000DF0DU),
10 EMIT_MASKWRITE(0xF8000110, 0x003FFFF0U, 0x000FA220U),
11 EMIT_MASKWRITE(0xF8000100, 0x0007F000U, 0x00028000U),
12 EMIT_MASKWRITE(0xF8000100, 0x00000010U, 0x00000010U),
13 EMIT_MASKWRITE(0xF8000100, 0x00000001U, 0x00000001U),
14 EMIT_MASKWRITE(0xF8000100, 0x00000001U, 0x00000000U),
15 EMIT_MASKPOLL(0xF800010C, 0x00000001U),
16 EMIT_MASKWRITE(0xF8000100, 0x00000010U, 0x00000000U),
17 EMIT_MASKWRITE(0xF8000120, 0x1F003F30U, 0x1F000200U),
18 EMIT_MASKWRITE(0xF8000114, 0x003FFFF0U, 0x0012C220U),
19 EMIT_MASKWRITE(0xF8000104, 0x0007F000U, 0x00020000U),
20 EMIT_MASKWRITE(0xF8000104, 0x00000010U, 0x00000010U),
21 EMIT_MASKWRITE(0xF8000104, 0x00000001U, 0x00000001U),
22 EMIT_MASKWRITE(0xF8000104, 0x00000001U, 0x00000000U),
23 EMIT_MASKPOLL(0xF800010C, 0x00000002U),
24 EMIT_MASKWRITE(0xF8000104, 0x00000010U, 0x00000000U),
25 EMIT_MASKWRITE(0xF8000124, 0xFFF00003U, 0x0C200003U),
26 EMIT_MASKWRITE(0xF8000118, 0x003FFFF0U, 0x001452C0U),
27 EMIT_MASKWRITE(0xF8000108, 0x0007F000U, 0x0001E000U),
28 EMIT_MASKWRITE(0xF8000108, 0x00000010U, 0x00000010U),
29 EMIT_MASKWRITE(0xF8000108, 0x00000001U, 0x00000001U),
30 EMIT_MASKWRITE(0xF8000108, 0x00000001U, 0x00000000U),
31 EMIT_MASKPOLL(0xF800010C, 0x00000004U),
32 EMIT_MASKWRITE(0xF8000108, 0x00000010U, 0x00000000U),
33 EMIT_WRITE(0xF8000004, 0x0000767BU),
34 EMIT_EXIT(),
35 };
36
37 static unsigned long ps7_clock_init_data[] = {
38 EMIT_WRITE(0xF8000008, 0x0000DF0DU),
39 EMIT_MASKWRITE(0xF8000128, 0x03F03F01U, 0x00700F01U),
40 EMIT_MASKWRITE(0xF8000138, 0x00000011U, 0x00000001U),
41 EMIT_MASKWRITE(0xF8000140, 0x03F03F71U, 0x00100801U),
42 EMIT_MASKWRITE(0xF800014C, 0x00003F31U, 0x00000501U),
43 EMIT_MASKWRITE(0xF8000150, 0x00003F33U, 0x00001401U),
44 EMIT_MASKWRITE(0xF8000154, 0x00003F33U, 0x00000A03U),
45 EMIT_MASKWRITE(0xF800015C, 0x03F03F33U, 0x00200501U),
46 EMIT_MASKWRITE(0xF8000160, 0x007F007FU, 0x00000000U),
47 EMIT_MASKWRITE(0xF8000168, 0x00003F31U, 0x00000501U),
48 EMIT_MASKWRITE(0xF8000170, 0x03F03F30U, 0x00200500U),
49 EMIT_MASKWRITE(0xF8000180, 0x03F03F30U, 0x00400500U),
50 EMIT_MASKWRITE(0xF80001C4, 0x00000001U, 0x00000001U),
51 EMIT_MASKWRITE(0xF800012C, 0x01FFCCCDU, 0x01FD044DU),
52 EMIT_WRITE(0xF8000004, 0x0000767BU),
53 EMIT_EXIT(),
54 };
55
56 static unsigned long ps7_ddr_init_data[] = {
57 EMIT_MASKWRITE(0xF8006000, 0x0001FFFFU, 0x00000080U),
58 EMIT_MASKWRITE(0xF8006004, 0x0007FFFFU, 0x00001082U),
59 EMIT_MASKWRITE(0xF8006008, 0x03FFFFFFU, 0x03C0780FU),
60 EMIT_MASKWRITE(0xF800600C, 0x03FFFFFFU, 0x02001001U),
61 EMIT_MASKWRITE(0xF8006010, 0x03FFFFFFU, 0x00014001U),
62 EMIT_MASKWRITE(0xF8006014, 0x001FFFFFU, 0x0004285BU),
63 EMIT_MASKWRITE(0xF8006018, 0xF7FFFFFFU, 0x44E458D3U),
64 EMIT_MASKWRITE(0xF800601C, 0xFFFFFFFFU, 0x7282BCE5U),
65 EMIT_MASKWRITE(0xF8006020, 0x7FDFFFFCU, 0x270872D0U),
66 EMIT_MASKWRITE(0xF8006024, 0x0FFFFFC3U, 0x00000000U),
67 EMIT_MASKWRITE(0xF8006028, 0x00003FFFU, 0x00002007U),
68 EMIT_MASKWRITE(0xF800602C, 0xFFFFFFFFU, 0x00000008U),
69 EMIT_MASKWRITE(0xF8006030, 0xFFFFFFFFU, 0x00040B30U),
70 EMIT_MASKWRITE(0xF8006034, 0x13FF3FFFU, 0x000116D4U),
71 EMIT_MASKWRITE(0xF8006038, 0x00000003U, 0x00000000U),
72 EMIT_MASKWRITE(0xF800603C, 0x000FFFFFU, 0x00000777U),
73 EMIT_MASKWRITE(0xF8006040, 0xFFFFFFFFU, 0xFFF00000U),
74 EMIT_MASKWRITE(0xF8006044, 0x0FFFFFFFU, 0x0F666666U),
75 EMIT_MASKWRITE(0xF8006048, 0x0003F03FU, 0x0003C008U),
76 EMIT_MASKWRITE(0xF8006050, 0xFF0F8FFFU, 0x77010800U),
77 EMIT_MASKWRITE(0xF8006058, 0x00010000U, 0x00000000U),
78 EMIT_MASKWRITE(0xF800605C, 0x0000FFFFU, 0x00005003U),
79 EMIT_MASKWRITE(0xF8006060, 0x000017FFU, 0x0000003EU),
80 EMIT_MASKWRITE(0xF8006064, 0x00021FE0U, 0x00020000U),
81 EMIT_MASKWRITE(0xF8006068, 0x03FFFFFFU, 0x00284141U),
82 EMIT_MASKWRITE(0xF800606C, 0x0000FFFFU, 0x00001610U),
83 EMIT_MASKWRITE(0xF8006078, 0x03FFFFFFU, 0x00466111U),
84 EMIT_MASKWRITE(0xF800607C, 0x000FFFFFU, 0x00032222U),
85 EMIT_MASKWRITE(0xF80060A4, 0xFFFFFFFFU, 0x10200802U),
86 EMIT_MASKWRITE(0xF80060A8, 0x0FFFFFFFU, 0x0690CB73U),
87 EMIT_MASKWRITE(0xF80060AC, 0x000001FFU, 0x000001FEU),
88 EMIT_MASKWRITE(0xF80060B0, 0x1FFFFFFFU, 0x1CFFFFFFU),
89 EMIT_MASKWRITE(0xF80060B4, 0x00000200U, 0x00000200U),
90 EMIT_MASKWRITE(0xF80060B8, 0x01FFFFFFU, 0x00200066U),
91 EMIT_MASKWRITE(0xF80060C4, 0x00000003U, 0x00000000U),
92 EMIT_MASKWRITE(0xF80060C8, 0x000000FFU, 0x00000000U),
93 EMIT_MASKWRITE(0xF80060DC, 0x00000001U, 0x00000000U),
94 EMIT_MASKWRITE(0xF80060F0, 0x0000FFFFU, 0x00000000U),
95 EMIT_MASKWRITE(0xF80060F4, 0x0000000FU, 0x00000008U),
96 EMIT_MASKWRITE(0xF8006114, 0x000000FFU, 0x00000000U),
97 EMIT_MASKWRITE(0xF8006118, 0x7FFFFFCFU, 0x40000001U),
98 EMIT_MASKWRITE(0xF800611C, 0x7FFFFFCFU, 0x40000001U),
99 EMIT_MASKWRITE(0xF8006120, 0x7FFFFFCFU, 0x40000001U),
100 EMIT_MASKWRITE(0xF8006124, 0x7FFFFFCFU, 0x40000001U),
101 EMIT_MASKWRITE(0xF800612C, 0x000FFFFFU, 0x0002A81FU),
102 EMIT_MASKWRITE(0xF8006130, 0x000FFFFFU, 0x00029822U),
103 EMIT_MASKWRITE(0xF8006134, 0x000FFFFFU, 0x00026C10U),
104 EMIT_MASKWRITE(0xF8006138, 0x000FFFFFU, 0x00026013U),
105 EMIT_MASKWRITE(0xF8006140, 0x000FFFFFU, 0x00000035U),
106 EMIT_MASKWRITE(0xF8006144, 0x000FFFFFU, 0x00000035U),
107 EMIT_MASKWRITE(0xF8006148, 0x000FFFFFU, 0x00000035U),
108 EMIT_MASKWRITE(0xF800614C, 0x000FFFFFU, 0x00000035U),
109 EMIT_MASKWRITE(0xF8006154, 0x000FFFFFU, 0x0000009FU),
110 EMIT_MASKWRITE(0xF8006158, 0x000FFFFFU, 0x000000A2U),
111 EMIT_MASKWRITE(0xF800615C, 0x000FFFFFU, 0x00000090U),
112 EMIT_MASKWRITE(0xF8006160, 0x000FFFFFU, 0x00000093U),
113 EMIT_MASKWRITE(0xF8006168, 0x001FFFFFU, 0x000000FFU),
114 EMIT_MASKWRITE(0xF800616C, 0x001FFFFFU, 0x000000FBU),
115 EMIT_MASKWRITE(0xF8006170, 0x001FFFFFU, 0x000000F0U),
116 EMIT_MASKWRITE(0xF8006174, 0x001FFFFFU, 0x000000EDU),
117 EMIT_MASKWRITE(0xF800617C, 0x000FFFFFU, 0x000000DFU),
118 EMIT_MASKWRITE(0xF8006180, 0x000FFFFFU, 0x000000E2U),
119 EMIT_MASKWRITE(0xF8006184, 0x000FFFFFU, 0x000000D0U),
120 EMIT_MASKWRITE(0xF8006188, 0x000FFFFFU, 0x000000D3U),
121 EMIT_MASKWRITE(0xF8006190, 0x6FFFFEFEU, 0x00040080U),
122 EMIT_MASKWRITE(0xF8006194, 0x000FFFFFU, 0x0001FC82U),
123 EMIT_MASKWRITE(0xF8006204, 0xFFFFFFFFU, 0x00000000U),
124 EMIT_MASKWRITE(0xF8006208, 0x000703FFU, 0x000003FFU),
125 EMIT_MASKWRITE(0xF800620C, 0x000703FFU, 0x000003FFU),
126 EMIT_MASKWRITE(0xF8006210, 0x000703FFU, 0x000003FFU),
127 EMIT_MASKWRITE(0xF8006214, 0x000703FFU, 0x000003FFU),
128 EMIT_MASKWRITE(0xF8006218, 0x000F03FFU, 0x000003FFU),
129 EMIT_MASKWRITE(0xF800621C, 0x000F03FFU, 0x000003FFU),
130 EMIT_MASKWRITE(0xF8006220, 0x000F03FFU, 0x000003FFU),
131 EMIT_MASKWRITE(0xF8006224, 0x000F03FFU, 0x000003FFU),
132 EMIT_MASKWRITE(0xF80062A8, 0x00000FF5U, 0x00000000U),
133 EMIT_MASKWRITE(0xF80062AC, 0xFFFFFFFFU, 0x00000000U),
134 EMIT_MASKWRITE(0xF80062B0, 0x003FFFFFU, 0x00005125U),
135 EMIT_MASKWRITE(0xF80062B4, 0x0003FFFFU, 0x000012A8U),
136 EMIT_MASKPOLL(0xF8000B74, 0x00002000U),
137 EMIT_MASKWRITE(0xF8006000, 0x0001FFFFU, 0x00000081U),
138 EMIT_MASKPOLL(0xF8006054, 0x00000007U),
139 EMIT_EXIT(),
140 };
141
142 static unsigned long ps7_mio_init_data[] = {
143 EMIT_WRITE(0xF8000008, 0x0000DF0DU),
144 EMIT_MASKWRITE(0xF8000B40, 0x00000FFFU, 0x00000600U),
145 EMIT_MASKWRITE(0xF8000B44, 0x00000FFFU, 0x00000600U),
146 EMIT_MASKWRITE(0xF8000B48, 0x00000FFFU, 0x00000672U),
147 EMIT_MASKWRITE(0xF8000B4C, 0x00000FFFU, 0x00000672U),
148 EMIT_MASKWRITE(0xF8000B50, 0x00000FFFU, 0x00000674U),
149 EMIT_MASKWRITE(0xF8000B54, 0x00000FFFU, 0x00000674U),
150 EMIT_MASKWRITE(0xF8000B58, 0x00000FFFU, 0x00000600U),
151 EMIT_MASKWRITE(0xF8000B5C, 0xFFFFFFFFU, 0x0018C61CU),
152 EMIT_MASKWRITE(0xF8000B60, 0xFFFFFFFFU, 0x00F9861CU),
153 EMIT_MASKWRITE(0xF8000B64, 0xFFFFFFFFU, 0x00F9861CU),
154 EMIT_MASKWRITE(0xF8000B68, 0xFFFFFFFFU, 0x00F9861CU),
155 EMIT_MASKWRITE(0xF8000B6C, 0x00007FFFU, 0x00000260U),
156 EMIT_MASKWRITE(0xF8000B70, 0x00000001U, 0x00000001U),
157 EMIT_MASKWRITE(0xF8000B70, 0x00000021U, 0x00000020U),
158 EMIT_MASKWRITE(0xF8000B70, 0x07FEFFFFU, 0x00000823U),
159 EMIT_MASKWRITE(0xF8000700, 0x00003FFFU, 0x00001600U),
160 EMIT_MASKWRITE(0xF8000704, 0x00003FFFU, 0x00000602U),
161 EMIT_MASKWRITE(0xF8000708, 0x00003FFFU, 0x00000602U),
162 EMIT_MASKWRITE(0xF800070C, 0x00003FFFU, 0x00000602U),
163 EMIT_MASKWRITE(0xF8000710, 0x00003FFFU, 0x00000602U),
164 EMIT_MASKWRITE(0xF8000714, 0x00003FFFU, 0x00000602U),
165 EMIT_MASKWRITE(0xF8000718, 0x00003FFFU, 0x00000602U),
166 EMIT_MASKWRITE(0xF800071C, 0x00003FFFU, 0x00000600U),
167 EMIT_MASKWRITE(0xF8000720, 0x00003FFFU, 0x00000602U),
168 EMIT_MASKWRITE(0xF8000724, 0x00003FFFU, 0x00000600U),
169 EMIT_MASKWRITE(0xF8000728, 0x00003FFFU, 0x000016E1U),
170 EMIT_MASKWRITE(0xF800072C, 0x00003FFFU, 0x000016E0U),
171 EMIT_MASKWRITE(0xF8000730, 0x00003FFFU, 0x00001640U),
172 EMIT_MASKWRITE(0xF8000734, 0x00003FFFU, 0x00001640U),
173 EMIT_MASKWRITE(0xF8000738, 0x00003FFFU, 0x00001621U),
174 EMIT_MASKWRITE(0xF800073C, 0x00003FFFU, 0x00001620U),
175 EMIT_MASKWRITE(0xF8000740, 0x00003FFFU, 0x00001202U),
176 EMIT_MASKWRITE(0xF8000744, 0x00003FFFU, 0x00001202U),
177 EMIT_MASKWRITE(0xF8000748, 0x00003FFFU, 0x00001202U),
178 EMIT_MASKWRITE(0xF800074C, 0x00003FFFU, 0x00001202U),
179 EMIT_MASKWRITE(0xF8000750, 0x00003FFFU, 0x00001202U),
180 EMIT_MASKWRITE(0xF8000754, 0x00003FFFU, 0x00001202U),
181 EMIT_MASKWRITE(0xF8000758, 0x00003FFFU, 0x00001203U),
182 EMIT_MASKWRITE(0xF800075C, 0x00003FFFU, 0x00001203U),
183 EMIT_MASKWRITE(0xF8000760, 0x00003FFFU, 0x00001203U),
184 EMIT_MASKWRITE(0xF8000764, 0x00003FFFU, 0x00001203U),
185 EMIT_MASKWRITE(0xF8000768, 0x00003FFFU, 0x00001203U),
186 EMIT_MASKWRITE(0xF800076C, 0x00003FFFU, 0x00001203U),
187 EMIT_MASKWRITE(0xF8000770, 0x00003FFFU, 0x00001204U),
188 EMIT_MASKWRITE(0xF8000774, 0x00003FFFU, 0x00001205U),
189 EMIT_MASKWRITE(0xF8000778, 0x00003FFFU, 0x00001204U),
190 EMIT_MASKWRITE(0xF800077C, 0x00003FFFU, 0x00001205U),
191 EMIT_MASKWRITE(0xF8000780, 0x00003FFFU, 0x00001204U),
192 EMIT_MASKWRITE(0xF8000784, 0x00003FFFU, 0x00001204U),
193 EMIT_MASKWRITE(0xF8000788, 0x00003FFFU, 0x00001204U),
194 EMIT_MASKWRITE(0xF800078C, 0x00003FFFU, 0x00001204U),
195 EMIT_MASKWRITE(0xF8000790, 0x00003FFFU, 0x00001205U),
196 EMIT_MASKWRITE(0xF8000794, 0x00003FFFU, 0x00001204U),
197 EMIT_MASKWRITE(0xF8000798, 0x00003FFFU, 0x00001204U),
198 EMIT_MASKWRITE(0xF800079C, 0x00003FFFU, 0x00001204U),
199 EMIT_MASKWRITE(0xF80007A0, 0x00003FFFU, 0x00001280U),
200 EMIT_MASKWRITE(0xF80007A4, 0x00003FFFU, 0x00001280U),
201 EMIT_MASKWRITE(0xF80007A8, 0x00003FFFU, 0x00001280U),
202 EMIT_MASKWRITE(0xF80007AC, 0x00003FFFU, 0x00001280U),
203 EMIT_MASKWRITE(0xF80007B0, 0x00003FFFU, 0x00001280U),
204 EMIT_MASKWRITE(0xF80007B4, 0x00003FFFU, 0x00001280U),
205 EMIT_MASKWRITE(0xF80007B8, 0x00003F01U, 0x00000201U),
206 EMIT_MASKWRITE(0xF80007BC, 0x00003F01U, 0x00000201U),
207 EMIT_MASKWRITE(0xF80007C0, 0x00003FFFU, 0x000012E0U),
208 EMIT_MASKWRITE(0xF80007C4, 0x00003FFFU, 0x000012E1U),
209 EMIT_MASKWRITE(0xF80007C8, 0x00003FFFU, 0x00000200U),
210 EMIT_MASKWRITE(0xF80007CC, 0x00003FFFU, 0x00000200U),
211 EMIT_MASKWRITE(0xF80007D0, 0x00003FFFU, 0x00001280U),
212 EMIT_MASKWRITE(0xF80007D4, 0x00003FFFU, 0x00001280U),
213 EMIT_MASKWRITE(0xF8000830, 0x003F003FU, 0x002E002FU),
214 EMIT_WRITE(0xF8000004, 0x0000767BU),
215 EMIT_EXIT(),
216 };
217
218 static unsigned long ps7_peripherals_init_data[] = {
219 EMIT_WRITE(0xF8000008, 0x0000DF0DU),
220 EMIT_MASKWRITE(0xF8000B48, 0x00000180U, 0x00000180U),
221 EMIT_MASKWRITE(0xF8000B4C, 0x00000180U, 0x00000180U),
222 EMIT_MASKWRITE(0xF8000B50, 0x00000180U, 0x00000180U),
223 EMIT_MASKWRITE(0xF8000B54, 0x00000180U, 0x00000180U),
224 EMIT_WRITE(0xF8000004, 0x0000767BU),
225 EMIT_MASKWRITE(0xE0001034, 0x000000FFU, 0x00000006U),
226 EMIT_MASKWRITE(0xE0001018, 0x0000FFFFU, 0x0000007CU),
227 EMIT_MASKWRITE(0xE0001000, 0x000001FFU, 0x00000017U),
228 EMIT_MASKWRITE(0xE0001004, 0x000003FFU, 0x00000020U),
229 EMIT_MASKWRITE(0xE0000034, 0x000000FFU, 0x00000006U),
230 EMIT_MASKWRITE(0xE0000018, 0x0000FFFFU, 0x0000007CU),
231 EMIT_MASKWRITE(0xE0000000, 0x000001FFU, 0x00000017U),
232 EMIT_MASKWRITE(0xE0000004, 0x000003FFU, 0x00000020U),
233 EMIT_MASKWRITE(0xE000D000, 0x00080000U, 0x00080000U),
234 EMIT_MASKWRITE(0xF8007000, 0x20000000U, 0x00000000U),
235 EMIT_MASKWRITE(0xE000A244, 0x003FFFFFU, 0x00080000U),
236 EMIT_MASKWRITE(0xE000A00C, 0x003F003FU, 0x00370008U),
237 EMIT_MASKWRITE(0xE000A248, 0x003FFFFFU, 0x00080000U),
238 EMIT_MASKWRITE(0xE000A00C, 0x003F003FU, 0x00370000U),
239 EMIT_MASKDELAY(0xF8F00200, 1),
240 EMIT_MASKWRITE(0xE000A00C, 0x003F003FU, 0x00370008U),
241 EMIT_EXIT(),
242 };
243
244 static unsigned long ps7_post_config_0[] = {
245 EMIT_WRITE(0xF8000008, 0x0000DF0DU),
246 EMIT_MASKWRITE(0xF8000900, 0x0000000FU, 0x0000000FU),
247 EMIT_MASKWRITE(0xF8000240, 0xFFFFFFFFU, 0x00000000U),
248 EMIT_WRITE(0xF8000004, 0x0000767BU),
249 EMIT_EXIT(),
250 };
251
ps7_post_config(void)252 int ps7_post_config(void)
253 {
254 return ps7_config(ps7_post_config_0);
255 }
256
ps7_init(void)257 int ps7_init(void)
258 {
259 int ret;
260
261 ret = ps7_config(ps7_mio_init_data);
262 if (ret != PS7_INIT_SUCCESS)
263 return ret;
264
265 ret = ps7_config(ps7_pll_init_data);
266 if (ret != PS7_INIT_SUCCESS)
267 return ret;
268
269 ret = ps7_config(ps7_clock_init_data);
270 if (ret != PS7_INIT_SUCCESS)
271 return ret;
272
273 ret = ps7_config(ps7_ddr_init_data);
274 if (ret != PS7_INIT_SUCCESS)
275 return ret;
276
277 ret = ps7_config(ps7_peripherals_init_data);
278 if (ret != PS7_INIT_SUCCESS)
279 return ret;
280 return PS7_INIT_SUCCESS;
281 }
282