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#include <common.h>
26#include <command.h>
27#include <libfdt.h>
28#include <mpc8xx.h>
29#include <hwconfig.h>
30#include <i2c.h>
31#include "../common/kup.h"
32#include <asm/io.h>
33
34static unsigned char swapbyte(unsigned char c);
35static int read_diag(void);
36
37DECLARE_GLOBAL_DATA_PTR;
38
39
40
41#define _NOT_USED_ 0xFFFFFFFF
42
43const uint sdram_table[] = {
44
45
46
47 0x1F07FC04, 0xEEAEFC04, 0x11ADFC04, 0xEFBBBC00,
48 0x1FF77C47,
49
50
51
52
53
54
55
56
57
58 0x1FF77C35, 0xEFEABC34, 0x1FB57C35,
59
60
61
62
63 0x1F07FC04, 0xEEAEFC04, 0x10ADFC04, 0xF0AFFC00,
64 0xF0AFFC00, 0xF1AFFC00, 0xEFBBBC00, 0x1FF77C47,
65 _NOT_USED_, _NOT_USED_, _NOT_USED_, _NOT_USED_,
66 _NOT_USED_, _NOT_USED_, _NOT_USED_, _NOT_USED_,
67
68
69
70
71 0x1F27FC04, 0xEEAEBC00, 0x01B93C04, 0x1FF77C47,
72 _NOT_USED_, _NOT_USED_, _NOT_USED_, _NOT_USED_,
73
74
75
76
77 0x1F07FC04, 0xEEAEBC00, 0x10AD7C00, 0xF0AFFC00,
78 0xF0AFFC00, 0xE1BBBC04, 0x1FF77C47,
79 _NOT_USED_,
80 _NOT_USED_, _NOT_USED_, _NOT_USED_, _NOT_USED_,
81 _NOT_USED_, _NOT_USED_, _NOT_USED_, _NOT_USED_,
82
83
84
85
86 0x1FF5FC84, 0xFFFFFC04, 0xFFFFFC04, 0xFFFFFC04,
87 0xFFFFFC84, 0xFFFFFC07,
88 _NOT_USED_, _NOT_USED_,
89 _NOT_USED_, _NOT_USED_, _NOT_USED_, _NOT_USED_,
90
91
92
93
94 0x7FFFFC07,
95 _NOT_USED_, _NOT_USED_, _NOT_USED_,
96};
97
98
99
100
101
102
103
104int checkboard(void)
105{
106 volatile immap_t *immap = (immap_t *) CONFIG_SYS_IMMR;
107 uchar rev,mod,tmp,pcf,ak_rev,ak_mod;
108
109
110
111
112 out_be32(&immap->im_memctl.memc_or4, CONFIG_SYS_OR4);
113 out_be32(&immap->im_memctl.memc_br4, CONFIG_SYS_BR4);
114
115
116
117
118 out_be32(&immap->im_memctl.memc_or5, CONFIG_SYS_OR5);
119 out_be32(&immap->im_memctl.memc_br5, CONFIG_SYS_BR5);
120
121 tmp = swapbyte(in_8((unsigned char*) LATCH_ADDR));
122 rev = (tmp & 0xF8) >> 3;
123 mod = (tmp & 0x07);
124
125 i2c_init(CONFIG_SYS_I2C_SPEED, CONFIG_SYS_I2C_SLAVE);
126
127 if (read_diag())
128 gd->flags &= ~GD_FLG_SILENT;
129
130 printf("Board: KUP4K Rev %d.%d AK:",rev,mod);
131
132
133
134
135 pcf = 0xFF;
136 i2c_write(0x21, 0, 0 , &pcf, 1);
137 if (i2c_read(0x21, 0, 0, &pcf, 1)) {
138 puts("n/a\n");
139 } else {
140 ak_rev = (pcf & 0xF8) >> 3;
141 ak_mod = (pcf & 0x07);
142 printf("%d.%d\n", ak_rev, ak_mod);
143 }
144 return 0;
145}
146
147
148
149
150phys_size_t initdram(int board_type)
151{
152 volatile immap_t *immap = (immap_t *) CONFIG_SYS_IMMR;
153 volatile memctl8xx_t *memctl = &immap->im_memctl;
154 long int size = 0;
155 uchar *latch, rev, tmp;
156
157
158
159
160
161 out_be32(&immap->im_memctl.memc_or4, CONFIG_SYS_OR4);
162 out_be32(&immap->im_memctl.memc_br4, CONFIG_SYS_BR4);
163
164 latch = (uchar *)0x90000200;
165 tmp = swapbyte(*latch);
166 rev = (tmp & 0xF8) >> 3;
167
168 upmconfig(UPMA, (uint *) sdram_table,
169 sizeof (sdram_table) / sizeof (uint));
170
171 out_be16(&memctl->memc_mptpr, CONFIG_SYS_MPTPR);
172
173 out_be32(&memctl->memc_mar, 0x00000088);
174
175 if(rev >= 7) {
176 out_be32(&memctl->memc_mamr,
177 CONFIG_SYS_MAMR_9COL & (~(MAMR_PTAE)));
178 } else {
179 out_be32(&memctl->memc_mamr,
180 CONFIG_SYS_MAMR_8COL & (~(MAMR_PTAE)));
181 }
182
183 udelay(200);
184
185
186
187
188 out_be32(&memctl->memc_mcr, 0x80002105);
189 udelay(1);
190 out_be32(&memctl->memc_mcr, 0x80002830);
191 udelay(1);
192 out_be32(&memctl->memc_mcr, 0x80002106);
193 udelay(1);
194
195
196 out_be32(&memctl->memc_mcr, 0x80004105);
197 udelay(1);
198 out_be32(&memctl->memc_mcr, 0x80004830);
199 udelay(1);
200 out_be32(&memctl->memc_mcr, 0x80004106);
201 udelay(1);
202
203
204 out_be32(&memctl->memc_mcr, 0x80006105);
205 udelay(1);
206 out_be32(&memctl->memc_mcr, 0x80006830);
207 udelay(1);
208 out_be32(&memctl->memc_mcr, 0x80006106);
209 udelay(1);
210
211 setbits_be32(&memctl->memc_mamr, MAMR_PTAE);
212 udelay(1000);
213
214 out_be16(&memctl->memc_mptpr, CONFIG_SYS_MPTPR);
215 udelay(1000);
216 if(rev >= 7) {
217 size = 32 * 3 * 1024 * 1024;
218 out_be32(&memctl->memc_or1, CONFIG_SYS_OR1_9COL);
219 out_be32(&memctl->memc_br1, CONFIG_SYS_BR1_9COL);
220 out_be32(&memctl->memc_or2, CONFIG_SYS_OR2_9COL);
221 out_be32(&memctl->memc_br2, CONFIG_SYS_BR2_9COL);
222 out_be32(&memctl->memc_or3, CONFIG_SYS_OR3_9COL);
223 out_be32(&memctl->memc_br3, CONFIG_SYS_BR3_9COL);
224 } else {
225 size = 16 * 3 * 1024 * 1024;
226 out_be32(&memctl->memc_or1, CONFIG_SYS_OR1_8COL);
227 out_be32(&memctl->memc_br1, CONFIG_SYS_BR1_8COL);
228 out_be32(&memctl->memc_or2, CONFIG_SYS_OR2_8COL);
229 out_be32(&memctl->memc_br2, CONFIG_SYS_BR2_8COL);
230 out_be32(&memctl->memc_or3, CONFIG_SYS_OR3_8COL);
231 out_be32(&memctl->memc_br3, CONFIG_SYS_BR3_8COL);
232 }
233 return (size);
234}
235
236
237
238
239int misc_init_r(void)
240{
241 volatile immap_t *immap = (immap_t *) CONFIG_SYS_IMMR;
242
243#ifdef CONFIG_IDE_LED
244
245 setbits_be16(&immap->im_ioport.iop_padir, PA_8);
246 setbits_be16(&immap->im_ioport.iop_paodr, PA_8);
247 clrbits_be16(&immap->im_ioport.iop_papar, PA_8);
248 setbits_be16(&immap->im_ioport.iop_padat, PA_8);
249#endif
250 load_sernum_ethaddr();
251 setenv("hw","4k");
252 poweron_key();
253 return (0);
254}
255
256
257static int read_diag(void)
258{
259 int diag;
260 immap_t *immr = (immap_t *)CONFIG_SYS_IMMR;
261
262 clrbits_be16(&immr->im_ioport.iop_pcdir, PC_4);
263 clrbits_be16(&immr->im_ioport.iop_pcpar, PC_4);
264 setbits_be16(&immr->im_ioport.iop_pcdir, PC_5);
265 clrbits_be16(&immr->im_ioport.iop_pcpar, PC_4);
266 setbits_be16(&immr->im_ioport.iop_pcdat, PC_5);
267 udelay(500);
268 if (in_be16(&immr->im_ioport.iop_pcdat) & PC_4) {
269 clrbits_be16(&immr->im_ioport.iop_pcdat, PC_5);
270 udelay(500);
271 if(in_be16(&immr->im_ioport.iop_pcdat) & PC_4)
272 diag = 0;
273 else
274 diag = 1;
275 } else {
276 diag = 0;
277 }
278 clrbits_be16(&immr->im_ioport.iop_pcdir, PC_5);
279 return (diag);
280}
281
282static unsigned char swapbyte(unsigned char c)
283{
284 unsigned char result = 0;
285 int i = 0;
286
287 for(i = 0; i < 8; ++i) {
288 result = result << 1;
289 result |= (c & 1);
290 c = c >> 1;
291 }
292 return result;
293}
294
295
296
297
298#if defined(CONFIG_OF_BOARD_SETUP) && defined(CONFIG_OF_LIBFDT)
299void ft_board_setup(void *blob, bd_t *bd)
300{
301 ft_cpu_setup(blob, bd);
302}
303#endif
304