]>
Commit | Line | Data |
---|---|---|
16f21704 WD |
1 | /* |
2 | * (C) Copyright 2000 | |
3 | * Wolfgang Denk, DENX Software Engineering, wd@denx.de. | |
4 | * | |
5 | * See file CREDITS for list of people who contributed to this | |
6 | * project. | |
7 | * | |
8 | * This program is free software; you can redistribute it and/or | |
9 | * modify it under the terms of the GNU General Public License as | |
10 | * published by the Free Software Foundation; either version 2 of | |
11 | * the License, or (at your option) any later version. | |
12 | * | |
13 | * This program is distributed in the hope that it will be useful, | |
14 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | |
15 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
16 | * GNU General Public License for more details. | |
17 | * | |
18 | * You should have received a copy of the GNU General Public License | |
19 | * along with this program; if not, write to the Free Software | |
20 | * Foundation, Inc., 59 Temple Place, Suite 330, Boston, | |
21 | * MA 02111-1307 USA | |
22 | */ | |
23 | ||
24 | #include <common.h> | |
25 | #include <commproc.h> | |
26 | #include <mpc8xx.h> | |
27 | ||
28 | #ifdef CONFIG_SHOW_BOOT_PROGRESS | |
29 | # include <status_led.h> | |
30 | # define SHOW_BOOT_PROGRESS(arg) show_boot_progress(arg) | |
31 | #else | |
32 | # define SHOW_BOOT_PROGRESS(arg) | |
33 | #endif | |
34 | ||
d87080b7 WD |
35 | DECLARE_GLOBAL_DATA_PTR; |
36 | ||
16f21704 WD |
37 | /* ------------------------------------------------------------------------- */ |
38 | ||
39 | static long int dram_size (long int, long int *, long int); | |
40 | static ulong board_init (void); | |
41 | static void send_smi_frame (volatile scc_t * sp, volatile cbd_t * bd, | |
42 | uchar * msg); | |
43 | ||
44 | /* ------------------------------------------------------------------------- */ | |
45 | ||
46 | #define _NOT_USED_ 0xFFFFFFFF | |
47 | ||
48 | const uint sdram_table[] = { | |
49 | /* | |
50 | * Single Read. (Offset 0 in UPMA RAM) | |
51 | */ | |
52 | 0x1f07fc04, 0xeeaefc04, 0x11adfc04, 0xefbbbc00, | |
53 | 0x1ff77c47, /* last */ | |
54 | /* | |
55 | * SDRAM Initialization (offset 5 in UPMA RAM) | |
56 | * | |
57 | * This is no UPM entry point. The following definition uses | |
58 | * the remaining space to establish an initialization | |
59 | * sequence, which is executed by a RUN command. | |
60 | * | |
61 | */ | |
62 | 0x1fe77c35, 0xffaffc34, 0x1fa57c35, /* last */ | |
63 | /* | |
64 | * Burst Read. (Offset 8 in UPMA RAM) | |
65 | */ | |
66 | 0x1f07fc04, 0xeeaefc04, 0x10adfc04, 0xf0affc00, | |
67 | 0xf0affc00, 0xf1affc00, 0xefbbbc00, 0x1ff77c47, /* last */ | |
68 | _NOT_USED_, _NOT_USED_, _NOT_USED_, _NOT_USED_, | |
69 | _NOT_USED_, _NOT_USED_, _NOT_USED_, _NOT_USED_, | |
70 | /* | |
71 | * Single Write. (Offset 18 in UPMA RAM) | |
72 | */ | |
73 | 0x1f27fc04, 0xeeaebc00, 0x01b93c04, 0x1ff77c47, /* last */ | |
74 | _NOT_USED_, _NOT_USED_, _NOT_USED_, _NOT_USED_, | |
75 | /* | |
76 | * Burst Write. (Offset 20 in UPMA RAM) | |
77 | */ | |
78 | 0x1f07fc04, 0xeeaebc00, 0x10ad4c00, 0xf0afcc00, | |
79 | 0xf0afcc00, 0xe1bb8c06, 0x1ff77c47, /* last */ | |
80 | _NOT_USED_, | |
81 | _NOT_USED_, _NOT_USED_, _NOT_USED_, _NOT_USED_, | |
82 | _NOT_USED_, _NOT_USED_, _NOT_USED_, _NOT_USED_, | |
83 | /* | |
84 | * Refresh (Offset 30 in UPMA RAM) | |
85 | */ | |
86 | 0x1ff5fc84, 0xfffffc04, 0xfffffc04, 0xfffffc04, | |
87 | 0xfffffc84, 0xfffffc07, /* last */ | |
88 | _NOT_USED_, _NOT_USED_, | |
89 | _NOT_USED_, _NOT_USED_, _NOT_USED_, _NOT_USED_, | |
90 | /* | |
91 | * Exception. (Offset 3c in UPMA RAM) | |
92 | */ | |
93 | 0x7ffffc07, /* last */ | |
94 | _NOT_USED_, _NOT_USED_, _NOT_USED_, | |
95 | }; | |
96 | ||
97 | /* ------------------------------------------------------------------------- */ | |
98 | ||
99 | ||
100 | /* | |
101 | * Check Board Identity: | |
102 | * | |
103 | * Test ID string (HERMES...) | |
104 | * | |
105 | * Return code for board revision and network speed | |
106 | */ | |
107 | ||
108 | int checkboard (void) | |
109 | { | |
77ddac94 WD |
110 | char *s = getenv ("serial#"); |
111 | char *e; | |
16f21704 WD |
112 | |
113 | puts ("Board: "); | |
114 | ||
115 | if (!s || strncmp (s, "HERMES", 6)) { | |
116 | puts ("### No HW ID - assuming HERMES-PRO"); | |
117 | } else { | |
118 | for (e = s; *e; ++e) { | |
119 | if (*e == ' ') | |
120 | break; | |
121 | } | |
122 | ||
123 | for (; s < e; ++s) { | |
124 | putc (*s); | |
125 | } | |
126 | } | |
127 | ||
128 | gd->board_type = board_init (); | |
129 | ||
130 | printf (" Rev. %ld.x\n", (gd->board_type >> 16)); | |
131 | ||
132 | return (0); | |
133 | } | |
134 | ||
135 | /* ------------------------------------------------------------------------- */ | |
136 | ||
9973e3c6 | 137 | phys_size_t initdram (int board_type) |
16f21704 | 138 | { |
6d0f6bcf | 139 | volatile immap_t *immap = (immap_t *) CONFIG_SYS_IMMR; |
16f21704 WD |
140 | volatile memctl8xx_t *memctl = &immap->im_memctl; |
141 | long int size, size8, size9; | |
142 | ||
143 | upmconfig (UPMA, (uint *) sdram_table, | |
144 | sizeof (sdram_table) / sizeof (uint)); | |
145 | ||
146 | /* | |
147 | * Preliminary prescaler for refresh | |
148 | */ | |
149 | memctl->memc_mptpr = 0x0400; | |
150 | ||
151 | memctl->memc_mar = 0x00000088; | |
152 | ||
153 | /* | |
154 | * Map controller banks 1 to the SDRAM banks at preliminary address | |
155 | */ | |
6d0f6bcf JCPV |
156 | memctl->memc_or1 = CONFIG_SYS_OR1_PRELIM; |
157 | memctl->memc_br1 = CONFIG_SYS_BR1_PRELIM; | |
16f21704 WD |
158 | |
159 | /* HERMES-PRO boards have only one bank SDRAM */ | |
160 | ||
161 | ||
162 | udelay (200); | |
163 | ||
164 | /* perform SDRAM initializsation sequence */ | |
165 | ||
166 | memctl->memc_mamr = 0xD0802114; | |
167 | memctl->memc_mcr = 0x80002105; | |
168 | udelay (1); | |
169 | memctl->memc_mamr = 0xD0802118; | |
170 | memctl->memc_mcr = 0x80002130; | |
171 | udelay (1); | |
172 | memctl->memc_mamr = 0xD0802114; | |
173 | memctl->memc_mcr = 0x80002106; | |
174 | ||
175 | udelay (1000); | |
176 | ||
177 | /* | |
178 | * Check Bank 0 Memory Size for re-configuration | |
179 | * | |
180 | * try 8 column mode | |
181 | */ | |
6d0f6bcf | 182 | size8 = dram_size (CONFIG_SYS_MAMR_8COL, (long *) SDRAM_BASE_PRELIM, |
16f21704 WD |
183 | SDRAM_MAX_SIZE); |
184 | ||
185 | udelay (1000); | |
186 | ||
187 | /* | |
188 | * try 9 column mode | |
189 | */ | |
6d0f6bcf | 190 | size9 = dram_size (CONFIG_SYS_MAMR_9COL, (long *) SDRAM_BASE_PRELIM, |
16f21704 WD |
191 | SDRAM_MAX_SIZE); |
192 | ||
193 | if (size8 < size9) { /* leave configuration at 9 columns */ | |
194 | size = size9; | |
195 | /* debug ("SDRAM Bank 0 in 9 column mode: %ld MB\n", size >> 20); */ | |
196 | } else { /* back to 8 columns */ | |
197 | size = size8; | |
6d0f6bcf | 198 | memctl->memc_mamr = CONFIG_SYS_MAMR_8COL; |
16f21704 WD |
199 | udelay (500); |
200 | /* debug ("SDRAM Bank 0 in 8 column mode: %ld MB\n", size >> 20); */ | |
201 | } | |
202 | ||
203 | udelay (1000); | |
204 | ||
205 | memctl->memc_or1 = ((-size) & 0xFFFF0000) | SDRAM_TIMING; | |
6d0f6bcf | 206 | memctl->memc_br1 = (CONFIG_SYS_SDRAM_BASE & BR_BA_MSK) | BR_MS_UPMA | BR_V; |
16f21704 WD |
207 | |
208 | udelay (10000); | |
209 | ||
210 | return (size); | |
211 | } | |
212 | ||
213 | /* ------------------------------------------------------------------------- */ | |
214 | ||
215 | /* | |
216 | * Check memory range for valid RAM. A simple memory test determines | |
217 | * the actually available RAM size between addresses `base' and | |
218 | * `base + maxsize'. Some (not all) hardware errors are detected: | |
219 | * - short between address lines | |
220 | * - short between data lines | |
221 | */ | |
222 | ||
223 | static long int dram_size (long int mamr_value, long int *base, | |
224 | long int maxsize) | |
225 | { | |
6d0f6bcf | 226 | volatile immap_t *immap = (immap_t *) CONFIG_SYS_IMMR; |
16f21704 | 227 | volatile memctl8xx_t *memctl = &immap->im_memctl; |
16f21704 WD |
228 | |
229 | memctl->memc_mamr = mamr_value; | |
230 | ||
c83bf6a2 | 231 | return (get_ram_size(base, maxsize)); |
16f21704 WD |
232 | } |
233 | ||
234 | /* ------------------------------------------------------------------------- */ | |
235 | ||
236 | #define PB_LED_3 0x00020000 /* Status LED's */ | |
237 | #define PB_LED_2 0x00010000 | |
238 | #define PB_LED_1 0x00008000 | |
239 | #define PB_LED_0 0x00004000 | |
240 | ||
241 | #define PB_LED_ALL (PB_LED_0 | PB_LED_1 | PB_LED_2 | PB_LED_3) | |
242 | ||
243 | #define PC_REP_SPD1 0x00000800 | |
244 | #define PC_REP_SPD0 0x00000400 | |
245 | ||
246 | #define PB_RESET_2081 0x00000020 /* Reset PEB2081 */ | |
247 | ||
248 | #define PB_MAI_4 0x00000010 /* Configuration */ | |
249 | #define PB_MAI_3 0x00000008 | |
250 | #define PB_MAI_2 0x00000004 | |
251 | #define PB_MAI_1 0x00000002 | |
252 | #define PB_MAI_0 0x00000001 | |
253 | ||
254 | #define PB_MAI_ALL (PB_MAI_0 | PB_MAI_1 | PB_MAI_2 | PB_MAI_3 | PB_MAI_4) | |
255 | ||
256 | ||
257 | #define PC_REP_MGRPRS 0x0200 | |
258 | #define PC_REP_SPD 0x0040 /* Select 100 Mbps */ | |
259 | #define PC_REP_RES 0x0004 | |
260 | #define PC_BIT14 0x0002 /* ??? */ | |
261 | #define PC_BIT15 0x0001 /* ??? ENDSL ?? */ | |
262 | ||
263 | /* ------------------------------------------------------------------------- */ | |
264 | ||
265 | static ulong board_init (void) | |
266 | { | |
6d0f6bcf | 267 | volatile immap_t *immr = (immap_t *) CONFIG_SYS_IMMR; |
16f21704 WD |
268 | ulong reg, revision, speed = 100; |
269 | int ethspeed; | |
270 | char *s; | |
271 | ||
272 | if ((s = getenv ("ethspeed")) != NULL) { | |
273 | if (strcmp (s, "100") == 0) { | |
274 | ethspeed = 100; | |
275 | } else if (strcmp (s, "10") == 0) { | |
276 | ethspeed = 10; | |
277 | } else { | |
278 | ethspeed = 0; | |
279 | } | |
280 | } else { | |
281 | ethspeed = 0; | |
282 | } | |
283 | ||
284 | /* Configure Port B Output Pins => 0x0003cc3F */ | |
285 | reg = PB_LED_ALL | PC_REP_SPD1 | PC_REP_SPD0 | PB_RESET_2081 | | |
286 | PB_MAI_ALL; | |
287 | immr->im_cpm.cp_pbpar &= ~reg; | |
288 | immr->im_cpm.cp_pbodr &= ~reg; | |
289 | immr->im_cpm.cp_pbdat &= ~reg; /* all 0 */ | |
290 | immr->im_cpm.cp_pbdir |= reg; | |
291 | ||
292 | /* Check hardware revision */ | |
293 | if ((immr->im_ioport.iop_pcdat & 0x0003) == 0x0003) { | |
294 | /* | |
295 | * Revision 3.x hardware | |
296 | */ | |
297 | revision = 3; | |
298 | ||
299 | immr->im_ioport.iop_pcdat = 0x0240; | |
300 | immr->im_ioport.iop_pcdir = (PC_REP_MGRPRS | PC_REP_SPD | PC_REP_RES | PC_BIT14); /* = 0x0246 */ | |
301 | immr->im_ioport.iop_pcdat |= PC_REP_RES; | |
302 | } else { | |
303 | immr->im_ioport.iop_pcdat = 0x0002; | |
304 | immr->im_ioport.iop_pcdir = (PC_REP_MGRPRS | PC_REP_RES | PC_BIT14 | PC_BIT15); /* = 0x0207 */ | |
305 | ||
306 | if ((immr->im_ioport.iop_pcdat & PC_REP_SPD) == 0) { | |
307 | /* | |
308 | * Revision 2.x hardware: PC9 connected to PB21 | |
309 | */ | |
310 | revision = 2; | |
311 | ||
312 | if (ethspeed == 0) { | |
313 | /* both 10 and 100 Mbps allowed: | |
314 | * select 10 Mbps and autonegotiation | |
315 | */ | |
316 | puts (" [10+100]"); | |
317 | immr->im_cpm.cp_pbdat = 0; /* SPD1:SPD0 = 0:0 - autonegot. */ | |
318 | speed = 10; | |
319 | } else if (ethspeed == 10) { | |
320 | /* we are asked for 10 Mbps, | |
321 | * so select 10 Mbps | |
322 | */ | |
323 | puts (" [10]"); | |
324 | immr->im_cpm.cp_pbdat = 0; /* ??? */ | |
325 | speed = 10; | |
326 | } else { | |
327 | /* anything else: | |
328 | * select 100 Mbps | |
329 | */ | |
330 | puts (" [100]"); | |
331 | immr->im_cpm.cp_pbdat = PC_REP_SPD0 | PC_REP_SPD1; | |
332 | /* SPD1:SPD0 = 1:1 - 100 Mbps */ | |
333 | speed = 100; | |
334 | } | |
335 | immr->im_ioport.iop_pcdat |= (PC_REP_RES | PC_BIT14); | |
336 | ||
337 | /* must be run from RAM */ | |
338 | /* start_lxt980 (speed); */ | |
339 | /*************************/ | |
340 | } else { | |
341 | /* | |
342 | * Revision 1.x hardware | |
343 | */ | |
344 | revision = 1; | |
345 | ||
346 | immr->im_ioport.iop_pcdat = PC_REP_MGRPRS | PC_BIT14; /* = 0x0202 */ | |
347 | immr->im_ioport.iop_pcdir = (PC_REP_MGRPRS | PC_REP_SPD | PC_REP_RES | PC_BIT14 | PC_BIT15); /* = 0x0247 */ | |
348 | ||
349 | if (ethspeed == 0) { | |
350 | /* both 10 and 100 Mbps allowed: | |
351 | * select 100 Mbps and autonegotiation | |
352 | */ | |
353 | puts (" [10+100]"); | |
354 | immr->im_cpm.cp_pbdat = 0; /* SPD1:SPD0 = 0:0 - autonegot. */ | |
355 | immr->im_ioport.iop_pcdat |= PC_REP_SPD; | |
356 | } else if (ethspeed == 10) { | |
357 | /* we are asked for 10 Mbps, | |
358 | * so select 10 Mbps | |
359 | */ | |
360 | puts (" [10]"); | |
361 | immr->im_cpm.cp_pbdat = PC_REP_SPD0; /* SPD1:SPD0 = 0:1 - 10 Mbps */ | |
362 | } else { | |
363 | /* anything else: | |
364 | * select 100 Mbps | |
365 | */ | |
366 | puts (" [100]"); | |
367 | immr->im_cpm.cp_pbdat = PC_REP_SPD0 | PC_REP_SPD1; | |
368 | /* SPD1:SPD0 = 1:1 - 100 Mbps */ | |
369 | immr->im_ioport.iop_pcdat |= PC_REP_SPD; | |
370 | } | |
371 | ||
372 | immr->im_ioport.iop_pcdat |= PC_REP_RES; | |
373 | } | |
374 | } | |
375 | SHOW_BOOT_PROGRESS (0x00); | |
376 | ||
377 | return ((revision << 16) | (speed & 0xFFFF)); | |
378 | } | |
379 | ||
380 | /* ------------------------------------------------------------------------- */ | |
381 | ||
382 | #define SCC_SM 1 /* Index => SCC2 */ | |
383 | #define PROFF PROFF_SCC2 | |
384 | ||
385 | #define SMI_MSGLEN 8 /* Length of SMI Messages */ | |
386 | ||
387 | #define PHYGPCR_ADDR 0x109 /* Port Enable */ | |
388 | #define PHYPCR_ADDR 0x132 /* PHY Port Control Reg. (port 1) */ | |
389 | #define LEDPCR_ADDR 0x141 /* LED Port Control Reg. */ | |
390 | #define RPRESET_ADDR 0x144 /* Repeater Reset */ | |
391 | ||
392 | #define PHYPCR_SPEED 0x2000 /* on for 100 Mbps, off for 10 Mbps */ | |
393 | #define PHYPCR_AN 0x1000 /* on to enable Auto-Negotiation */ | |
394 | #define PHYPCR_REST_AN 0x0200 /* on to restart Auto-Negotiation */ | |
395 | #define PHYPCR_FDX 0x0100 /* on for Full Duplex, off for HDX */ | |
396 | #define PHYPCR_COLT 0x0080 /* on to enable COL signal test */ | |
397 | ||
398 | /* ------------------------------------------------------------------------- */ | |
399 | ||
400 | /* | |
401 | * Must run from RAM: | |
402 | * uses parameter RAM area which is used for stack while running from ROM | |
403 | */ | |
404 | void hermes_start_lxt980 (int speed) | |
405 | { | |
6d0f6bcf | 406 | volatile immap_t *immr = (immap_t *) CONFIG_SYS_IMMR; |
16f21704 WD |
407 | volatile cpm8xx_t *cp = (cpm8xx_t *) & (immr->im_cpm); |
408 | volatile scc_t *sp = (scc_t *) & (cp->cp_scc[SCC_SM]); | |
409 | volatile cbd_t *bd; | |
410 | volatile hdlc_pram_t *hp; | |
411 | uchar smimsg[SMI_MSGLEN]; | |
412 | ushort phypcrval; | |
413 | uint bd_off; | |
414 | int pnr; | |
415 | ||
416 | printf ("LXT9880: %3d Mbps\n", speed); | |
417 | ||
418 | immr->im_ioport.iop_paodr |= 0x0008; /* init PAODR: PA12 (TXD2) open drain */ | |
419 | immr->im_ioport.iop_papar |= 0x400c; /* init PAPAR: TXD2, RXD2, BRGO4 */ | |
420 | immr->im_ioport.iop_padir &= 0xbff3; /* init PADIR: BRGO4 */ | |
421 | immr->im_ioport.iop_padir |= 0x4000; | |
422 | ||
423 | /* get temporary BD; no need for permanent alloc */ | |
424 | bd_off = dpram_base_align (8); | |
425 | ||
426 | bd = (cbd_t *) (immr->im_cpm.cp_dpmem + bd_off); | |
427 | ||
428 | bd->cbd_bufaddr = 0; | |
429 | bd->cbd_datlen = 0; | |
430 | bd->cbd_sc = BD_SC_WRAP | BD_SC_LAST | BD_SC_INTRPT | BD_SC_TC; | |
431 | ||
432 | /* init. baudrate generator BRG4 */ | |
433 | cp->cp_brgc4 = (0x00010000 | (50 << 1)); /* output 1 MHz */ | |
434 | ||
435 | cp->cp_sicr &= 0xFFFF00FF; /* SICR: mask SCC2 */ | |
436 | cp->cp_sicr |= 0x00001B00; /* SICR: SCC2 clk BRG4 */ | |
437 | ||
438 | /* init SCC_SM register */ | |
439 | sp->scc_psmr = 0x0000; /* init PSMR: no additional flags */ | |
440 | sp->scc_todr = 0x0000; | |
441 | sp->scc_dsr = 0x7e7e; | |
442 | ||
443 | /* init. SCC_SM parameter area */ | |
444 | hp = (hdlc_pram_t *) & cp->cp_dparam[PROFF]; | |
445 | ||
446 | hp->tbase = bd_off; /* offset from beginning of DPRAM */ | |
447 | ||
448 | hp->rfcr = 0x18; | |
449 | hp->tfcr = 0x18; | |
450 | hp->mrblr = 10; | |
451 | ||
452 | hp->c_mask = 0x0000f0b8; | |
453 | hp->c_pres = 0x0000ffff; | |
454 | ||
455 | hp->disfc = 0; | |
456 | hp->crcec = 0; | |
457 | hp->abtsc = 0; | |
458 | hp->nmarc = 0; | |
459 | hp->retrc = 0; | |
460 | ||
461 | hp->mflr = 10; | |
462 | ||
463 | hp->rfthr = 1; | |
464 | ||
465 | hp->hmask = 0; | |
466 | hp->haddr1 = 0; | |
467 | hp->haddr2 = 0; | |
468 | hp->haddr3 = 0; | |
469 | hp->haddr4 = 0; | |
470 | ||
471 | cp->cp_cpcr = SCC_SM << 6 | 0x0001; /* SCC_SM: init TX/RX params */ | |
472 | while (cp->cp_cpcr & CPM_CR_FLG); | |
473 | ||
474 | /* clear all outstanding SCC events */ | |
475 | sp->scc_scce = ~0; | |
476 | ||
477 | /* enable transmitter: GSMR_L: TPL=2(16bits), TPP=3(all ones), ENT */ | |
478 | sp->scc_gsmrh = 0; | |
479 | sp->scc_gsmrl |= SCC_GSMRL_TPL_16 | SCC_GSMRL_TPP_ALL1 | | |
480 | SCC_GSMRL_ENT | SCC_GSMRL_MODE_HDLC; | |
481 | ||
482 | #if 0 | |
483 | smimsg[0] = 0x00; /* CHIP/HUB ID */ | |
484 | smimsg[1] = 0x38; /* WRITE CMD */ | |
485 | smimsg[2] = (RPRESET_ADDR << 4) & 0xf0; | |
486 | smimsg[3] = RPRESET_ADDR >> 4; | |
487 | smimsg[4] = 0x01; | |
488 | smimsg[5] = 0x00; | |
489 | smimsg[6] = 0x00; | |
490 | smimsg[7] = 0x00; | |
491 | ||
492 | send_smi_frame (sp, bd, smimsg); | |
493 | #endif | |
494 | ||
495 | smimsg[0] = 0x7f; /* BROADCAST */ | |
496 | smimsg[1] = 0x34; /* ASSIGN HUB ID */ | |
497 | smimsg[2] = 0x00; | |
498 | smimsg[3] = 0x00; | |
499 | smimsg[4] = 0x00; /* HUB ID = 0 */ | |
500 | smimsg[5] = 0x00; | |
501 | smimsg[6] = 0x00; | |
502 | smimsg[7] = 0x00; | |
503 | ||
504 | send_smi_frame (sp, bd, smimsg); | |
505 | ||
506 | smimsg[0] = 0x7f; /* BROADCAST */ | |
507 | smimsg[1] = 0x3c; /* SET ARBOUT TO 0 */ | |
508 | smimsg[2] = 0x00; /* ADDRESS = 0 */ | |
509 | smimsg[3] = 0x00; | |
510 | smimsg[4] = 0x00; /* DATA = 0 */ | |
511 | smimsg[5] = 0x00; | |
512 | smimsg[6] = 0x00; | |
513 | smimsg[7] = 0x00; | |
514 | ||
515 | send_smi_frame (sp, bd, smimsg); | |
516 | ||
517 | if (speed == 100) { | |
518 | phypcrval = PHYPCR_SPEED; /* 100 MBIT, disable autoneg. */ | |
519 | } else { | |
520 | phypcrval = 0; /* 10 MBIT, disable autoneg. */ | |
521 | } | |
522 | ||
523 | /* send MSGs */ | |
524 | for (pnr = 0; pnr < 8; pnr++) { | |
525 | smimsg[0] = 0x00; /* CHIP/HUB ID */ | |
526 | smimsg[1] = 0x38; /* WRITE CMD */ | |
527 | smimsg[2] = ((PHYPCR_ADDR + pnr) << 4) & 0xf0; | |
528 | smimsg[3] = (PHYPCR_ADDR + pnr) >> 4; | |
529 | smimsg[4] = (unsigned char) (phypcrval & 0xff); | |
530 | smimsg[5] = (unsigned char) (phypcrval >> 8); | |
531 | smimsg[6] = 0x00; | |
532 | smimsg[7] = 0x00; | |
533 | ||
534 | send_smi_frame (sp, bd, smimsg); | |
535 | } | |
536 | ||
537 | smimsg[0] = 0x00; /* CHIP/HUB ID */ | |
538 | smimsg[1] = 0x38; /* WRITE CMD */ | |
539 | smimsg[2] = (PHYGPCR_ADDR << 4) & 0xf0; | |
540 | smimsg[3] = PHYGPCR_ADDR >> 4; | |
541 | smimsg[4] = 0xff; /* enable port 1-8 */ | |
542 | smimsg[5] = 0x01; /* enable MII1 (0x01) */ | |
543 | smimsg[6] = 0x00; | |
544 | smimsg[7] = 0x00; | |
545 | ||
546 | send_smi_frame (sp, bd, smimsg); | |
547 | ||
548 | smimsg[0] = 0x00; /* CHIP/HUB ID */ | |
549 | smimsg[1] = 0x38; /* WRITE CMD */ | |
550 | smimsg[2] = (LEDPCR_ADDR << 4) & 0xf0; | |
551 | smimsg[3] = LEDPCR_ADDR >> 4; | |
552 | smimsg[4] = 0xaa; /* Port 1-8 Conf.bits = 10 (Hardware control) */ | |
553 | smimsg[5] = 0xaa; | |
554 | smimsg[6] = 0x00; | |
555 | smimsg[7] = 0x00; | |
556 | ||
557 | send_smi_frame (sp, bd, smimsg); | |
558 | ||
559 | /* | |
560 | * Disable Transmitter (so that we can free the BD, too) | |
561 | */ | |
562 | sp->scc_gsmrl &= ~SCC_GSMRL_ENT; | |
563 | } | |
564 | ||
565 | /* ------------------------------------------------------------------------- */ | |
566 | ||
567 | static void send_smi_frame (volatile scc_t * sp, volatile cbd_t * bd, | |
568 | uchar * msg) | |
569 | { | |
570 | #ifdef DEBUG | |
571 | unsigned hub, chip, cmd, length, addr; | |
572 | ||
573 | hub = msg[0] & 0x1F; | |
574 | chip = msg[0] >> 5; | |
575 | cmd = msg[1] & 0x1F; | |
576 | length = (msg[1] >> 5) | ((msg[2] & 0x0F) << 3); | |
577 | addr = (msg[2] >> 4) | (msg[3] << 4); | |
578 | ||
579 | printf ("SMI send: Hub %02x Chip %x Cmd %02x Len %d Addr %03x: " | |
580 | "%02x %02x %02x %02x\n", | |
581 | hub, chip, cmd, length, addr, msg[4], msg[5], msg[6], msg[7]); | |
582 | #endif /* DEBUG */ | |
583 | ||
584 | bd->cbd_bufaddr = (uint) msg; | |
585 | bd->cbd_datlen = SMI_MSGLEN; | |
586 | bd->cbd_sc |= BD_SC_READY; | |
587 | ||
588 | /* wait for msg transmitted */ | |
589 | while ((sp->scc_scce & 0x0002) == 0); | |
590 | /* clear all events */ | |
591 | sp->scc_scce = ~0; | |
592 | } | |
593 | ||
594 | /* ------------------------------------------------------------------------- */ | |
595 | ||
596 | void show_boot_progress (int status) | |
597 | { | |
6d0f6bcf | 598 | volatile immap_t *immr = (immap_t *) CONFIG_SYS_IMMR; |
16f21704 | 599 | |
566a494f | 600 | if (status < -32) status = -1; /* let things compatible */ |
16f21704 WD |
601 | status ^= 0x0F; |
602 | status = (status & 0x0F) << 14; | |
603 | immr->im_cpm.cp_pbdat = (immr->im_cpm.cp_pbdat & ~PB_LED_ALL) | status; | |
604 | } | |
605 | ||
606 | /* ------------------------------------------------------------------------- */ |