1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248
249
250
251
252
253
254
255
256
257
258
259
260
261
262
263
264
265
266
267
268
269
270
271
272
273
274
275
276
277
278
279
280
|
// SPDX-License-Identifier: GPL-2.0
/*
* (C) Copyright 2018 Michal Simek
*/
#include <asm/arch/ps7_init_gpl.h>
static unsigned long ps7_pll_init_data_3_0[] = {
EMIT_MASKWRITE(0xf8000008, 0x0000ffff, 0x0000df0d),
EMIT_MASKWRITE(0xf8000110, 0x003ffff0, 0x000fa220),
EMIT_MASKWRITE(0xf8000100, 0x0007f000, 0x00028000),
EMIT_MASKWRITE(0xf8000100, 0x00000010, 0x00000010),
EMIT_MASKWRITE(0xf8000100, 0x00000001, 0x00000001),
EMIT_MASKWRITE(0xf8000100, 0x00000001, 0x00000000),
EMIT_MASKPOLL(0xf800010c, 0x00000001),
EMIT_MASKWRITE(0xf8000100, 0x00000010, 0x00000000),
EMIT_MASKWRITE(0xf8000120, 0x1f003f30, 0x1f000200),
EMIT_MASKWRITE(0xf8000114, 0x003ffff0, 0x0012c220),
EMIT_MASKWRITE(0xf8000104, 0x0007f000, 0x00020000),
EMIT_MASKWRITE(0xf8000104, 0x00000010, 0x00000010),
EMIT_MASKWRITE(0xf8000104, 0x00000001, 0x000000),
EMIT_MASKWRITE(0xf8000104, 0x00000001, 0x00000000),
EMIT_MASKPOLL(0xf800010c, 0x00000002),
EMIT_MASKWRITE(0xf8000104, 0x00000010, 0x00000000),
EMIT_MASKWRITE(0xf8000124, 0xfff00003, 0x0c200003),
EMIT_MASKWRITE(0xf8000118, 0x003ffff0, 0x001452c0),
EMIT_MASKWRITE(0xf8000108, 0x0007f000, 0x0001e000),
EMIT_MASKWRITE(0xf8000108, 0x00000010, 0x00000010),
EMIT_MASKWRITE(0xf8000108, 0x00000001, 0x00000001),
EMIT_MASKWRITE(0xf8000108, 0x00000001, 0x00000000),
EMIT_MASKPOLL(0xf800010c, 0x00000004),
EMIT_MASKWRITE(0xf8000108, 0x00000010, 0x00000000),
EMIT_MASKWRITE(0xf8000004, 0x0000ffff, 0x0000767b),
EMIT_EXIT(),
};
static unsigned long ps7_clock_init_data_3_0[] = {
EMIT_MASKWRITE(0xf8000008, 0x0000ffff, 0x0000df0d),
EMIT_MASKWRITE(0xf8000128, 0x03f03f01, 0x00302301),
EMIT_MASKWRITE(0xf8000138, 0x00000011, 0x00000001),
EMIT_MASKWRITE(0xf8000140, 0x03f03f71, 0x00100801),
EMIT_MASKWRITE(0xf8000148, 0x00003f31, 0x00000a01),
EMIT_MASKWRITE(0xf8000150, 0x00003f33, 0x00002801),
EMIT_MASKWRITE(0xf8000154, 0x00003f33, 0x00001402),
EMIT_MASKWRITE(0xf8000168, 0x00003f31, 0x00000501),
EMIT_MASKWRITE(0xf8000170, 0x03f03f30, 0x00101400),
EMIT_MASKWRITE(0xf8000180, 0x03f03f30, 0x00100a00),
EMIT_MASKWRITE(0xf8000190, 0x03f03f30, 0x00101e00),
EMIT_MASKWRITE(0xf80001a0, 0x03f03f30, 0x00101400),
EMIT_MASKWRITE(0xf80001c4, 0x00000001, 0x00000001),
EMIT_MASKWRITE(0xf800012c, 0x01ffcccd, 0x016c044d),
EMIT_MASKWRITE(0xf8000004, 0x0000ffff, 0x0000767b),
EMIT_EXIT(),
};
static unsigned long ps7_ddr_init_data_3_0[] = {
EMIT_MASKWRITE(0xf8006000, 0x0001ffff, 0x00000080),
EMIT_MASKWRITE(0xf8006004, 0x0007ffff, 0x00001081),
EMIT_MASKWRITE(0xf8006008, 0x03ffffff, 0x03c0780f),
EMIT_MASKWRITE(0xf800600c, 0x03ffffff, 0x02001001),
EMIT_MASKWRITE(0xf8006010, 0x03ffffff, 0x00014001),
EMIT_MASKWRITE(0xf8006014, 0x001fffff, 0x0004281b),
EMIT_MASKWRITE(0xf8006018, 0xf7ffffff, 0x44e458d1),
EMIT_MASKWRITE(0xf800601c, 0xffffffff, 0xb2023584),
EMIT_MASKWRITE(0xf8006020, 0x7fdffffc, 0x2b08b2d0),
EMIT_MASKWRITE(0xf8006024, 0x0fffffc3, 0x00000000),
EMIT_MASKWRITE(0xf8006028, 0x00003fff, 0x00002007),
EMIT_MASKWRITE(0xf800602c, 0xffffffff, 0x00000000),
EMIT_MASKWRITE(0xf8006030, 0xffffffff, 0x00040970),
EMIT_MASKWRITE(0xf8006034, 0x13ff3fff, 0x000116d4),
EMIT_MASKWRITE(0xf8006038, 0x00000003, 0x00000000),
EMIT_MASKWRITE(0xf800603c, 0x000fffff, 0x00000777),
EMIT_MASKWRITE(0xf8006040, 0xffffffff, 0xfff00000),
EMIT_MASKWRITE(0xf8006044, 0x0fffffff, 0x0f666666),
EMIT_MASKWRITE(0xf8006048, 0x0003f03f, 0x0003c008),
EMIT_MASKWRITE(0xf8006050, 0xff0f8fff, 0x77010800),
EMIT_MASKWRITE(0xf8006058, 0x00010000, 0x00000000),
EMIT_MASKWRITE(0xf800605c, 0x0000ffff, 0x00005003),
EMIT_MASKWRITE(0xf8006060, 0x000017ff, 0x0000003e),
EMIT_MASKWRITE(0xf8006064, 0x00021fe0, 0x00020000),
EMIT_MASKWRITE(0xf8006068, 0x03ffffff, 0x00284545),
EMIT_MASKWRITE(0xf800606c, 0x0000ffff, 0x00001610),
EMIT_MASKWRITE(0xf8006078, 0x03ffffff, 0x00466111),
EMIT_MASKWRITE(0xf800607c, 0x000fffff, 0x00032222),
EMIT_MASKWRITE(0xf80060a4, 0xffffffff, 0x10200802),
EMIT_MASKWRITE(0xf80060a8, 0x0fffffff, 0x0690cb73),
EMIT_MASKWRITE(0xf80060ac, 0x000001ff, 0x000001fe),
EMIT_MASKWRITE(0xf80060b0, 0x1fffffff, 0x1cffffff),
EMIT_MASKWRITE(0xf80060b4, 0x00000200, 0x00000200),
EMIT_MASKWRITE(0xf80060b8, 0x01ffffff, 0x0020006a),
EMIT_MASKWRITE(0xf80060c4, 0x00000003, 0x00000003),
EMIT_MASKWRITE(0xf80060c4, 0x00000003, 0x00000000),
EMIT_MASKWRITE(0xf80060c8, 0x000000ff, 0x00000000),
EMIT_MASKWRITE(0xf80060dc, 0x00000001, 0x00000000),
EMIT_MASKWRITE(0xf80060f0, 0x0000ffff, 0x00000000),
EMIT_MASKWRITE(0xf80060f4, 0x0000000f, 0x00000008),
EMIT_MASKWRITE(0xf8006114, 0x000000ff, 0x00000000),
EMIT_MASKWRITE(0xf8006118, 0x7fffffcf, 0x40000001),
EMIT_MASKWRITE(0xf800611c, 0x7fffffcf, 0x40000001),
EMIT_MASKWRITE(0xf8006120, 0x7fffffcf, 0x40000001),
EMIT_MASKWRITE(0xf8006124, 0x7fffffcf, 0x40000001),
EMIT_MASKWRITE(0xf800612c, 0x000fffff, 0x0002c000),
EMIT_MASKWRITE(0xf8006130, 0x000fffff, 0x0002c400),
EMIT_MASKWRITE(0xf8006134, 0x000fffff, 0x0002f003),
EMIT_MASKWRITE(0xf8006138, 0x000fffff, 0x0002ec03),
EMIT_MASKWRITE(0xf8006140, 0x000fffff, 0x00000035),
EMIT_MASKWRITE(0xf8006144, 0x000fffff, 0x00000035),
EMIT_MASKWRITE(0xf8006148, 0x000fffff, 0x00000035),
EMIT_MASKWRITE(0xf800614c, 0x000fffff, 0x00000035),
EMIT_MASKWRITE(0xf8006154, 0x000fffff, 0x00000077),
EMIT_MASKWRITE(0xf8006158, 0x000fffff, 0x00000077),
EMIT_MASKWRITE(0xf800615c, 0x000fffff, 0x00000083),
EMIT_MASKWRITE(0xf8006160, 0x000fffff, 0x00000083),
EMIT_MASKWRITE(0xf8006168, 0x001fffff, 0x00000105),
EMIT_MASKWRITE(0xf800616c, 0x001fffff, 0x00000106),
EMIT_MASKWRITE(0xf8006170, 0x001fffff, 0x00000111),
EMIT_MASKWRITE(0xf8006174, 0x001fffff, 0x00000110),
EMIT_MASKWRITE(0xf800617c, 0x000fffff, 0x000000b7),
EMIT_MASKWRITE(0xf8006180, 0x000fffff, 0x000000b7),
EMIT_MASKWRITE(0xf8006184, 0x000fffff, 0x000000c3),
EMIT_MASKWRITE(0xf8006188, 0x000fffff, 0x000000c3),
EMIT_MASKWRITE(0xf8006190, 0x6ffffefe, 0x00040080),
EMIT_MASKWRITE(0xf8006194, 0x000fffff, 0x0001fd01),
EMIT_MASKWRITE(0xf8006204, 0xffffffff, 0x00000000),
EMIT_MASKWRITE(0xf8006208, 0x000703ff, 0x000003ff),
EMIT_MASKWRITE(0xf800620c, 0x000703ff, 0x000003ff),
EMIT_MASKWRITE(0xf8006210, 0x000703ff, 0x000003ff),
EMIT_MASKWRITE(0xf8006214, 0x000703ff, 0x000003ff),
EMIT_MASKWRITE(0xf8006218, 0x000f03ff, 0x000003ff),
EMIT_MASKWRITE(0xf800621c, 0x000f03ff, 0x000003ff),
EMIT_MASKWRITE(0xf8006220, 0x000f03ff, 0x000003ff),
EMIT_MASKWRITE(0xf8006224, 0x000f03ff, 0x000003ff),
EMIT_MASKWRITE(0xf80062a8, 0x00000ff5, 0x00000000),
EMIT_MASKWRITE(0xf80062ac, 0xffffffff, 0x00000000),
EMIT_MASKWRITE(0xf80062b0, 0x003fffff, 0x00005125),
EMIT_MASKWRITE(0xf80062b4, 0x0003ffff, 0x000012a8),
EMIT_MASKPOLL(0xf8000b74, 0x00002000),
EMIT_MASKWRITE(0xf8006000, 0x0001ffff, 0x00000081),
EMIT_MASKPOLL(0xf8006054, 0x00000007),
EMIT_EXIT(),
};
static unsigned long ps7_mio_init_data_3_0[] = {
EMIT_MASKWRITE(0xf8000008, 0x0000ffff, 0x0000df0d),
EMIT_MASKWRITE(0xf8000b40, 0x00000fff, 0x00000600),
EMIT_MASKWRITE(0xf8000b44, 0x00000fff, 0x00000600),
EMIT_MASKWRITE(0xf8000b48, 0x00000fff, 0x00000672),
EMIT_MASKWRITE(0xf8000b4c, 0x00000fff, 0x00000672),
EMIT_MASKWRITE(0xf8000b50, 0x00000fff, 0x00000674),
EMIT_MASKWRITE(0xf8000b54, 0x00000fff, 0x00000674),
EMIT_MASKWRITE(0xf8000b58, 0x00000fff, 0x00000600),
EMIT_MASKWRITE(0xf8000b5c, 0xffffffff, 0x0018c068),
EMIT_MASKWRITE(0xf8000b60, 0xffffffff, 0x00f98068),
EMIT_MASKWRITE(0xf8000b64, 0xffffffff, 0x00f98068),
EMIT_MASKWRITE(0xf8000b68, 0xffffffff, 0x00f98068),
EMIT_MASKWRITE(0xf8000b6c, 0x00007fff, 0x00000205),
EMIT_MASKWRITE(0xf8000b70, 0x00000001, 0x00000001),
EMIT_MASKWRITE(0xf8000b70, 0x00000021, 0x00000020),
EMIT_MASKWRITE(0xf8000b70, 0x07feffff, 0x00000823),
EMIT_MASKWRITE(0xf8000700, 0x00003fff, 0x00000610),
EMIT_MASKWRITE(0xf8000704, 0x00003fff, 0x00000600),
EMIT_MASKWRITE(0xf8000708, 0x00003fff, 0x00000610),
EMIT_MASKWRITE(0xf800070c, 0x00003fff, 0x00000610),
EMIT_MASKWRITE(0xf8000710, 0x00003fff, 0x00000610),
EMIT_MASKWRITE(0xf8000714, 0x00003fff, 0x00000610),
EMIT_MASKWRITE(0xf8000718, 0x00003fff, 0x00000610),
EMIT_MASKWRITE(0xf800071c, 0x00003fff, 0x00000610),
EMIT_MASKWRITE(0xf8000720, 0x00003fff, 0x00000610),
EMIT_MASKWRITE(0xf8000724, 0x00003fff, 0x00000610),
EMIT_MASKWRITE(0xf8000728, 0x00003fff, 0x00000610),
EMIT_MASKWRITE(0xf800072c, 0x00003fff, 0x00000610),
EMIT_MASKWRITE(0xf8000730, 0x00003fff, 0x00000610),
EMIT_MASKWRITE(0xf8000734, 0x00003fff, 0x00000610),
EMIT_MASKWRITE(0xf8000738, 0x00003fff, 0x00000611),
EMIT_MASKWRITE(0xf800073c, 0x00003fff, 0x00000600),
EMIT_MASKWRITE(0xf8000740, 0x00003fff, 0x00000202),
EMIT_MASKWRITE(0xf8000744, 0x00003fff, 0x00000202),
EMIT_MASKWRITE(0xf8000748, 0x00003fff, 0x00000202),
EMIT_MASKWRITE(0xf800074c, 0x00003fff, 0x00000202),
EMIT_MASKWRITE(0xf8000750, 0x00003fff, 0x00000202),
EMIT_MASKWRITE(0xf8000754, 0x00003fff, 0x00000202),
EMIT_MASKWRITE(0xf8000758, 0x00003fff, 0x00000203),
EMIT_MASKWRITE(0xf800075c, 0x00003fff, 0x00000203),
EMIT_MASKWRITE(0xf8000760, 0x00003fff, 0x00000203),
EMIT_MASKWRITE(0xf8000764, 0x00003fff, 0x00000203),
EMIT_MASKWRITE(0xf8000768, 0x00003fff, 0x00000203),
EMIT_MASKWRITE(0xf800076c, 0x00003fff, 0x00000203),
EMIT_MASKWRITE(0xf8000770, 0x00003fff, 0x00000200),
EMIT_MASKWRITE(0xf8000774, 0x00003fff, 0x00000200),
EMIT_MASKWRITE(0xf8000778, 0x00003fff, 0x00000200),
EMIT_MASKWRITE(0xf800077c, 0x00003fff, 0x00000200),
EMIT_MASKWRITE(0xf8000780, 0x00003fff, 0x00000200),
EMIT_MASKWRITE(0xf8000784, 0x00003fff, 0x00000200),
EMIT_MASKWRITE(0xf8000788, 0x00003fff, 0x00000200),
EMIT_MASKWRITE(0xf800078c, 0x00003fff, 0x00000200),
EMIT_MASKWRITE(0xf8000790, 0x00003fff, 0x00000200),
EMIT_MASKWRITE(0xf8000794, 0x00003fff, 0x00000200),
EMIT_MASKWRITE(0xf8000798, 0x00003fff, 0x00000200),
EMIT_MASKWRITE(0xf800079c, 0x00003fff, 0x00000200),
EMIT_MASKWRITE(0xf80007a0, 0x00003fff, 0x00000280),
EMIT_MASKWRITE(0xf80007a4, 0x00003fff, 0x00000280),
EMIT_MASKWRITE(0xf80007a8, 0x00003fff, 0x00000280),
EMIT_MASKWRITE(0xf80007ac, 0x00003fff, 0x00000280),
EMIT_MASKWRITE(0xf80007b0, 0x00003fff, 0x00000280),
EMIT_MASKWRITE(0xf80007b4, 0x00003fff, 0x00000280),
EMIT_MASKWRITE(0xf80007b8, 0x00003f01, 0x00000201),
EMIT_MASKWRITE(0xf80007bc, 0x00003fff, 0x00000200),
EMIT_MASKWRITE(0xf80007c0, 0x00003fff, 0x000002e0),
EMIT_MASKWRITE(0xf80007c4, 0x00003fff, 0x000002e1),
EMIT_MASKWRITE(0xf80007c8, 0x00003f01, 0x00000201),
EMIT_MASKWRITE(0xf80007cc, 0x00003fff, 0x00000200),
EMIT_MASKWRITE(0xf80007d0, 0x00003fff, 0x00000280),
EMIT_MASKWRITE(0xf80007d4, 0x00003fff, 0x00000280),
EMIT_MASKWRITE(0xf8000830, 0x003f003f, 0x002e0032),
EMIT_MASKWRITE(0xf8000004, 0x0000ffff, 0x0000767b),
EMIT_EXIT(),
};
static unsigned long ps7_peripherals_init_data_3_0[] = {
EMIT_MASKWRITE(0xf8000008, 0x0000ffff, 0x0000df0d),
EMIT_MASKWRITE(0xf8000b48, 0x00000180, 0x00000180),
EMIT_MASKWRITE(0xf8000b4c, 0x00000180, 0x00000180),
EMIT_MASKWRITE(0xf8000b50, 0x00000180, 0x00000180),
EMIT_MASKWRITE(0xf8000b54, 0x00000180, 0x00000180),
EMIT_MASKWRITE(0xf8000004, 0x0000ffff, 0x0000767b),
EMIT_MASKWRITE(0xe0001034, 0x000000ff, 0x00000006),
EMIT_MASKWRITE(0xe0001018, 0x0000ffff, 0x0000003e),
EMIT_MASKWRITE(0xe0001000, 0x000001ff, 0x00000017),
EMIT_MASKWRITE(0xe0001004, 0x000003ff, 0x00000020),
EMIT_MASKWRITE(0xe000d000, 0x00080000, 0x00080000),
EMIT_MASKWRITE(0xf8007000, 0x20000000, 0x00000000),
EMIT_MASKWRITE(0xe000e014, 0x00ffffff, 0x00449144),
EMIT_MASKWRITE(0xe000e018, 0x00000003, 0x00000000),
EMIT_MASKWRITE(0xe000e010, 0x03e00000, 0x02400000),
EMIT_MASKDELAY(0xf8f00200, 0x00000001),
EMIT_MASKDELAY(0xf8f00200, 0x00000001),
EMIT_MASKDELAY(0xf8f00200, 0x00000001),
EMIT_MASKDELAY(0xf8f00200, 0x00000001),
EMIT_MASKDELAY(0xf8f00200, 0x00000001),
EMIT_MASKDELAY(0xf8f00200, 0x00000001),
EMIT_EXIT(),
};
static unsigned long ps7_post_config_3_0[] = {
EMIT_MASKWRITE(0xf8000008, 0x0000ffff, 0x0000df0d),
EMIT_MASKWRITE(0xf8000900, 0x0000000f, 0x0000000f),
EMIT_MASKWRITE(0xf8000240, 0xffffffff, 0x00000000),
EMIT_MASKWRITE(0xf8008000, 0x00000001, 0x00000001),
EMIT_MASKWRITE(0xf8008014, 0x00000001, 0x00000001),
EMIT_MASKWRITE(0xf8000004, 0x0000ffff, 0x0000767b),
EMIT_EXIT(),
};
int ps7_init(void)
{
int ret;
ret = ps7_config(ps7_mio_init_data_3_0);
if (ret != PS7_INIT_SUCCESS)
return ret;
ret = ps7_config(ps7_pll_init_data_3_0);
if (ret != PS7_INIT_SUCCESS)
return ret;
ret = ps7_config(ps7_clock_init_data_3_0);
if (ret != PS7_INIT_SUCCESS)
return ret;
ret = ps7_config(ps7_ddr_init_data_3_0);
if (ret != PS7_INIT_SUCCESS)
return ret;
ret = ps7_config(ps7_peripherals_init_data_3_0);
if (ret != PS7_INIT_SUCCESS)
return ret;
return PS7_INIT_SUCCESS;
}
int ps7_post_config(void)
{
return ps7_config(ps7_post_config_3_0);
}
|
