]>
Commit | Line | Data |
---|---|---|
e625881a ML |
1 | /* |
2 | * (c) Copyright 2010-2014 Xilinx, Inc. All rights reserved. | |
3 | * (c) Copyright 2016 Topic Embedded Products. | |
4 | * | |
5 | * SPDX-License-Identifier: GPL-2.0+ | |
6 | */ | |
7 | ||
c0823a76 | 8 | #include <asm/arch/ps7_init_gpl.h> |
e625881a ML |
9 | |
10 | static unsigned long ps7_pll_init_data_3_0[] = { | |
11 | EMIT_MASKWRITE(0xF8000008, 0x0000FFFFU, 0x0000DF0DU), | |
12 | EMIT_MASKWRITE(0xF8000110, 0x003FFFF0U, 0x000FA220U), | |
13 | EMIT_MASKWRITE(0xF8000100, 0x0007F000U, 0x00028000U), | |
14 | EMIT_MASKWRITE(0xF8000100, 0x00000010U, 0x00000010U), | |
15 | EMIT_MASKWRITE(0xF8000100, 0x00000001U, 0x00000001U), | |
16 | EMIT_MASKWRITE(0xF8000100, 0x00000001U, 0x00000000U), | |
17 | EMIT_MASKPOLL(0xF800010C, 0x00000001U), | |
18 | EMIT_MASKWRITE(0xF8000100, 0x00000010U, 0x00000000U), | |
19 | EMIT_MASKWRITE(0xF8000120, 0x1F003F30U, 0x1F000200U), | |
20 | EMIT_MASKWRITE(0xF8000114, 0x003FFFF0U, 0x0012C220U), | |
21 | EMIT_MASKWRITE(0xF8000104, 0x0007F000U, 0x00020000U), | |
22 | EMIT_MASKWRITE(0xF8000104, 0x00000010U, 0x00000010U), | |
23 | EMIT_MASKWRITE(0xF8000104, 0x00000001U, 0x00000001U), | |
24 | EMIT_MASKWRITE(0xF8000104, 0x00000001U, 0x00000000U), | |
25 | EMIT_MASKPOLL(0xF800010C, 0x00000002U), | |
26 | EMIT_MASKWRITE(0xF8000104, 0x00000010U, 0x00000000U), | |
27 | EMIT_MASKWRITE(0xF8000124, 0xFFF00003U, 0x0C200003U), | |
28 | EMIT_MASKWRITE(0xF8000118, 0x003FFFF0U, 0x00113220U), | |
29 | EMIT_MASKWRITE(0xF8000108, 0x0007F000U, 0x00024000U), | |
30 | EMIT_MASKWRITE(0xF8000108, 0x00000010U, 0x00000010U), | |
31 | EMIT_MASKWRITE(0xF8000108, 0x00000001U, 0x00000001U), | |
32 | EMIT_MASKWRITE(0xF8000108, 0x00000001U, 0x00000000U), | |
33 | EMIT_MASKPOLL(0xF800010C, 0x00000004U), | |
34 | EMIT_MASKWRITE(0xF8000108, 0x00000010U, 0x00000000U), | |
35 | EMIT_MASKWRITE(0xF8000004, 0x0000FFFFU, 0x0000767BU), | |
36 | EMIT_EXIT(), | |
37 | }; | |
38 | ||
39 | static unsigned long ps7_clock_init_data_3_0[] = { | |
40 | EMIT_MASKWRITE(0xF8000008, 0x0000FFFFU, 0x0000DF0DU), | |
41 | EMIT_MASKWRITE(0xF8000128, 0x03F03F01U, 0x00302301U), | |
42 | EMIT_MASKWRITE(0xF8000138, 0x00000011U, 0x00000011U), | |
43 | EMIT_MASKWRITE(0xF800013C, 0x00000011U, 0x00000011U), | |
44 | EMIT_MASKWRITE(0xF8000140, 0x03F03F71U, 0x00100141U), | |
45 | EMIT_MASKWRITE(0xF8000144, 0x03F03F71U, 0x00100141U), | |
46 | EMIT_MASKWRITE(0xF8000148, 0x00003F31U, 0x00000C01U), | |
47 | EMIT_MASKWRITE(0xF800014C, 0x00003F31U, 0x00000601U), | |
48 | EMIT_MASKWRITE(0xF8000150, 0x00003F33U, 0x00001803U), | |
49 | EMIT_MASKWRITE(0xF8000154, 0x00003F33U, 0x00000C03U), | |
50 | EMIT_MASKWRITE(0xF8000158, 0x00003F33U, 0x00000601U), | |
51 | EMIT_MASKWRITE(0xF8000168, 0x00003F31U, 0x00000601U), | |
52 | EMIT_MASKWRITE(0xF8000170, 0x03F03F30U, 0x00100C00U), | |
53 | EMIT_MASKWRITE(0xF8000180, 0x03F03F30U, 0x00100C00U), | |
54 | EMIT_MASKWRITE(0xF8000190, 0x03F03F30U, 0x00100600U), | |
55 | EMIT_MASKWRITE(0xF80001A0, 0x03F03F30U, 0x00101800U), | |
56 | EMIT_MASKWRITE(0xF80001C4, 0x00000001U, 0x00000001U), | |
57 | EMIT_MASKWRITE(0xF800012C, 0x01FFCCCDU, 0x01FC4C4DU), | |
58 | EMIT_MASKWRITE(0xF8000004, 0x0000FFFFU, 0x0000767BU), | |
59 | EMIT_EXIT(), | |
60 | }; | |
61 | ||
62 | static unsigned long ps7_ddr_init_data_3_0[] = { | |
63 | EMIT_MASKWRITE(0xF8006000, 0x0001FFFFU, 0x00000080U), | |
64 | EMIT_MASKWRITE(0xF8006004, 0x0007FFFFU, 0x00001081U), | |
65 | EMIT_MASKWRITE(0xF8006008, 0x03FFFFFFU, 0x03C0780FU), | |
66 | EMIT_MASKWRITE(0xF800600C, 0x03FFFFFFU, 0x02001001U), | |
67 | EMIT_MASKWRITE(0xF8006010, 0x03FFFFFFU, 0x00014001U), | |
68 | EMIT_MASKWRITE(0xF8006014, 0x001FFFFFU, 0x0004281AU), | |
69 | EMIT_MASKWRITE(0xF8006018, 0xF7FFFFFFU, 0x44E458D2U), | |
70 | EMIT_MASKWRITE(0xF800601C, 0xFFFFFFFFU, 0x720238E5U), | |
71 | EMIT_MASKWRITE(0xF8006020, 0x7FDFFFFCU, 0x270872D0U), | |
72 | EMIT_MASKWRITE(0xF8006024, 0x0FFFFFC3U, 0x00000000U), | |
73 | EMIT_MASKWRITE(0xF8006028, 0x00003FFFU, 0x00002007U), | |
74 | EMIT_MASKWRITE(0xF800602C, 0xFFFFFFFFU, 0x00000008U), | |
75 | EMIT_MASKWRITE(0xF8006030, 0xFFFFFFFFU, 0x00040930U), | |
76 | EMIT_MASKWRITE(0xF8006034, 0x13FF3FFFU, 0x000116D4U), | |
77 | EMIT_MASKWRITE(0xF8006038, 0x00000003U, 0x00000000U), | |
78 | EMIT_MASKWRITE(0xF800603C, 0x000FFFFFU, 0x00000777U), | |
79 | EMIT_MASKWRITE(0xF8006040, 0xFFFFFFFFU, 0xFFF00000U), | |
80 | EMIT_MASKWRITE(0xF8006044, 0x0FFFFFFFU, 0x0F666666U), | |
81 | EMIT_MASKWRITE(0xF8006048, 0x0003F03FU, 0x0003C008U), | |
82 | EMIT_MASKWRITE(0xF8006050, 0xFF0F8FFFU, 0x77010800U), | |
83 | EMIT_MASKWRITE(0xF8006058, 0x00010000U, 0x00000000U), | |
84 | EMIT_MASKWRITE(0xF800605C, 0x0000FFFFU, 0x00005003U), | |
85 | EMIT_MASKWRITE(0xF8006060, 0x000017FFU, 0x0000003EU), | |
86 | EMIT_MASKWRITE(0xF8006064, 0x00021FE0U, 0x00020000U), | |
87 | EMIT_MASKWRITE(0xF8006068, 0x03FFFFFFU, 0x00284141U), | |
88 | EMIT_MASKWRITE(0xF800606C, 0x0000FFFFU, 0x00001610U), | |
89 | EMIT_MASKWRITE(0xF8006078, 0x03FFFFFFU, 0x00466111U), | |
90 | EMIT_MASKWRITE(0xF800607C, 0x000FFFFFU, 0x00032222U), | |
91 | EMIT_MASKWRITE(0xF80060A4, 0xFFFFFFFFU, 0x10200802U), | |
92 | EMIT_MASKWRITE(0xF80060A8, 0x0FFFFFFFU, 0x0690CB73U), | |
93 | EMIT_MASKWRITE(0xF80060AC, 0x000001FFU, 0x000001FEU), | |
94 | EMIT_MASKWRITE(0xF80060B0, 0x1FFFFFFFU, 0x1CFFFFFFU), | |
95 | EMIT_MASKWRITE(0xF80060B4, 0x00000200U, 0x00000200U), | |
96 | EMIT_MASKWRITE(0xF80060B8, 0x01FFFFFFU, 0x00200066U), | |
97 | EMIT_MASKWRITE(0xF80060C4, 0x00000003U, 0x00000003U), | |
98 | EMIT_MASKWRITE(0xF80060C4, 0x00000003U, 0x00000000U), | |
99 | EMIT_MASKWRITE(0xF80060C8, 0x000000FFU, 0x00000000U), | |
100 | EMIT_MASKWRITE(0xF80060DC, 0x00000001U, 0x00000000U), | |
101 | EMIT_MASKWRITE(0xF80060F0, 0x0000FFFFU, 0x00000000U), | |
102 | EMIT_MASKWRITE(0xF80060F4, 0x0000000FU, 0x00000008U), | |
103 | EMIT_MASKWRITE(0xF8006114, 0x000000FFU, 0x00000000U), | |
104 | EMIT_MASKWRITE(0xF8006118, 0x7FFFFFCFU, 0x40000001U), | |
105 | EMIT_MASKWRITE(0xF800611C, 0x7FFFFFCFU, 0x40000001U), | |
106 | EMIT_MASKWRITE(0xF8006120, 0x7FFFFFCFU, 0x40000001U), | |
107 | EMIT_MASKWRITE(0xF8006124, 0x7FFFFFCFU, 0x40000001U), | |
108 | EMIT_MASKWRITE(0xF800612C, 0x000FFFFFU, 0x0003482CU), | |
109 | EMIT_MASKWRITE(0xF8006130, 0x000FFFFFU, 0x00033032U), | |
110 | EMIT_MASKWRITE(0xF8006134, 0x000FFFFFU, 0x0002E81FU), | |
111 | EMIT_MASKWRITE(0xF8006138, 0x000FFFFFU, 0x0002F81AU), | |
112 | EMIT_MASKWRITE(0xF8006140, 0x000FFFFFU, 0x00000035U), | |
113 | EMIT_MASKWRITE(0xF8006144, 0x000FFFFFU, 0x00000035U), | |
114 | EMIT_MASKWRITE(0xF8006148, 0x000FFFFFU, 0x00000035U), | |
115 | EMIT_MASKWRITE(0xF800614C, 0x000FFFFFU, 0x00000035U), | |
116 | EMIT_MASKWRITE(0xF8006154, 0x000FFFFFU, 0x000000ACU), | |
117 | EMIT_MASKWRITE(0xF8006158, 0x000FFFFFU, 0x000000B2U), | |
118 | EMIT_MASKWRITE(0xF800615C, 0x000FFFFFU, 0x0000009FU), | |
119 | EMIT_MASKWRITE(0xF8006160, 0x000FFFFFU, 0x0000009AU), | |
120 | EMIT_MASKWRITE(0xF8006168, 0x001FFFFFU, 0x00000127U), | |
121 | EMIT_MASKWRITE(0xF800616C, 0x001FFFFFU, 0x00000121U), | |
122 | EMIT_MASKWRITE(0xF8006170, 0x001FFFFFU, 0x0000010FU), | |
123 | EMIT_MASKWRITE(0xF8006174, 0x001FFFFFU, 0x00000113U), | |
124 | EMIT_MASKWRITE(0xF800617C, 0x000FFFFFU, 0x000000ECU), | |
125 | EMIT_MASKWRITE(0xF8006180, 0x000FFFFFU, 0x000000F2U), | |
126 | EMIT_MASKWRITE(0xF8006184, 0x000FFFFFU, 0x000000DFU), | |
127 | EMIT_MASKWRITE(0xF8006188, 0x000FFFFFU, 0x000000DAU), | |
128 | EMIT_MASKWRITE(0xF8006190, 0xFFFFFFFFU, 0x1002E080U), | |
129 | EMIT_MASKWRITE(0xF8006194, 0x000FFFFFU, 0x0001FC82U), | |
130 | EMIT_MASKWRITE(0xF8006204, 0xFFFFFFFFU, 0x00000000U), | |
131 | EMIT_MASKWRITE(0xF8006208, 0x000703FFU, 0x000003FFU), | |
132 | EMIT_MASKWRITE(0xF800620C, 0x000703FFU, 0x000003FFU), | |
133 | EMIT_MASKWRITE(0xF8006210, 0x000703FFU, 0x000003FFU), | |
134 | EMIT_MASKWRITE(0xF8006214, 0x000703FFU, 0x000003FFU), | |
135 | EMIT_MASKWRITE(0xF8006218, 0x000F03FFU, 0x000003FFU), | |
136 | EMIT_MASKWRITE(0xF800621C, 0x000F03FFU, 0x000003FFU), | |
137 | EMIT_MASKWRITE(0xF8006220, 0x000F03FFU, 0x000003FFU), | |
138 | EMIT_MASKWRITE(0xF8006224, 0x000F03FFU, 0x000003FFU), | |
139 | EMIT_MASKWRITE(0xF80062A8, 0x00000FF5U, 0x00000000U), | |
140 | EMIT_MASKWRITE(0xF80062AC, 0xFFFFFFFFU, 0x00000000U), | |
141 | EMIT_MASKWRITE(0xF80062B0, 0x003FFFFFU, 0x00005125U), | |
142 | EMIT_MASKWRITE(0xF80062B4, 0x0003FFFFU, 0x000012A8U), | |
143 | EMIT_MASKPOLL(0xF8000B74, 0x00002000U), | |
144 | EMIT_MASKWRITE(0xF8006000, 0x0001FFFFU, 0x00000081U), | |
145 | EMIT_MASKPOLL(0xF8006054, 0x00000007U), | |
146 | EMIT_EXIT(), | |
147 | }; | |
148 | ||
149 | static unsigned long ps7_mio_init_data_3_0[] = { | |
150 | EMIT_MASKWRITE(0xF8000008, 0x0000FFFFU, 0x0000DF0DU), | |
151 | EMIT_MASKWRITE(0xF8000B40, 0x00000FFFU, 0x00000600U), | |
152 | EMIT_MASKWRITE(0xF8000B44, 0x00000FFFU, 0x00000600U), | |
153 | EMIT_MASKWRITE(0xF8000B48, 0x00000FFFU, 0x00000672U), | |
154 | EMIT_MASKWRITE(0xF8000B4C, 0x00000FFFU, 0x00000672U), | |
155 | EMIT_MASKWRITE(0xF8000B50, 0x00000FFFU, 0x00000674U), | |
156 | EMIT_MASKWRITE(0xF8000B54, 0x00000FFFU, 0x00000674U), | |
157 | EMIT_MASKWRITE(0xF8000B58, 0x00000FFFU, 0x00000600U), | |
158 | EMIT_MASKWRITE(0xF8000B5C, 0xFFFFFFFFU, 0x0018C61CU), | |
159 | EMIT_MASKWRITE(0xF8000B60, 0xFFFFFFFFU, 0x00F9861CU), | |
160 | EMIT_MASKWRITE(0xF8000B64, 0xFFFFFFFFU, 0x00F9861CU), | |
161 | EMIT_MASKWRITE(0xF8000B68, 0xFFFFFFFFU, 0x00F9861CU), | |
162 | EMIT_MASKWRITE(0xF8000B6C, 0x00007FFFU, 0x00000E60U), | |
163 | EMIT_MASKWRITE(0xF8000B70, 0x00000001U, 0x00000001U), | |
164 | EMIT_MASKWRITE(0xF8000B70, 0x00000021U, 0x00000020U), | |
165 | EMIT_MASKWRITE(0xF8000B70, 0x07FEFFFFU, 0x00000823U), | |
166 | EMIT_MASKWRITE(0xF8000004, 0x0000FFFFU, 0x0000767BU), | |
167 | EMIT_EXIT(), | |
168 | }; | |
169 | ||
170 | static unsigned long ps7_peripherals_init_data_3_0[] = { | |
171 | EMIT_MASKWRITE(0xF8000008, 0x0000FFFFU, 0x0000DF0DU), | |
172 | EMIT_MASKWRITE(0xF8000B48, 0x00000180U, 0x00000180U), | |
173 | EMIT_MASKWRITE(0xF8000B4C, 0x00000180U, 0x00000180U), | |
174 | EMIT_MASKWRITE(0xF8000B50, 0x00000180U, 0x00000180U), | |
175 | EMIT_MASKWRITE(0xF8000B54, 0x00000180U, 0x00000180U), | |
176 | EMIT_MASKWRITE(0xF8000004, 0x0000FFFFU, 0x0000767BU), | |
177 | EMIT_MASKWRITE(0xE0001034, 0x000000FFU, 0x00000006U), | |
178 | EMIT_MASKWRITE(0xE0001018, 0x0000FFFFU, 0x0000007CU), | |
179 | EMIT_MASKWRITE(0xE0001000, 0x000001FFU, 0x00000017U), | |
180 | EMIT_MASKWRITE(0xE0001004, 0x000003FFU, 0x00000020U), | |
181 | EMIT_MASKWRITE(0xE0000034, 0x000000FFU, 0x00000006U), | |
182 | EMIT_MASKWRITE(0xE0000018, 0x0000FFFFU, 0x0000007CU), | |
183 | EMIT_MASKWRITE(0xE0000000, 0x000001FFU, 0x00000017U), | |
184 | EMIT_MASKWRITE(0xE0000004, 0x000003FFU, 0x00000020U), | |
185 | EMIT_MASKWRITE(0xE000D000, 0x000800FFU, 0x000800C1U), | |
186 | EMIT_MASKWRITE(0xF8007000, 0x20000000U, 0x00000000U), | |
187 | EMIT_MASKDELAY(0xF8F00200, 1), | |
188 | EMIT_MASKDELAY(0xF8F00200, 1), | |
189 | EMIT_MASKDELAY(0xF8F00200, 1), | |
190 | EMIT_EXIT(), | |
191 | }; | |
192 | ||
193 | static unsigned long ps7_post_config_3_0[] = { | |
194 | EMIT_MASKWRITE(0xF8000008, 0x0000FFFFU, 0x0000DF0DU), | |
195 | EMIT_MASKWRITE(0xF8000900, 0x0000000FU, 0x0000000FU), | |
196 | EMIT_MASKWRITE(0xF8000240, 0xFFFFFFFFU, 0x00000000U), | |
197 | EMIT_MASKWRITE(0xF8000004, 0x0000FFFFU, 0x0000767BU), | |
198 | EMIT_EXIT(), | |
199 | }; | |
200 | ||
201 | int ps7_init(void) | |
202 | { | |
203 | int ret; | |
204 | ||
205 | ret = ps7_config(ps7_mio_init_data_3_0); | |
206 | if (ret != PS7_INIT_SUCCESS) | |
207 | return ret; | |
208 | ret = ps7_config(ps7_pll_init_data_3_0); | |
209 | if (ret != PS7_INIT_SUCCESS) | |
210 | return ret; | |
211 | ret = ps7_config(ps7_clock_init_data_3_0); | |
212 | if (ret != PS7_INIT_SUCCESS) | |
213 | return ret; | |
214 | ret = ps7_config(ps7_ddr_init_data_3_0); | |
215 | if (ret != PS7_INIT_SUCCESS) | |
216 | return ret; | |
217 | ret = ps7_config(ps7_peripherals_init_data_3_0); | |
218 | if (ret != PS7_INIT_SUCCESS) | |
219 | return ret; | |
220 | ||
221 | return PS7_INIT_SUCCESS; | |
222 | } | |
223 | ||
224 | int ps7_post_config(void) | |
225 | { | |
226 | return ps7_config(ps7_post_config_3_0); | |
227 | } |