2 * Copyright 2007 Freescale Semiconductor.
4 * (C) Copyright 2003 Motorola Inc.
5 * Modified by Xianghua Xiao, X.Xiao@motorola.com
8 * Wolfgang Denk, DENX Software Engineering, wd@denx.de.
10 * See file CREDITS for list of people who contributed to this
13 * This program is free software; you can redistribute it and/or
14 * modify it under the terms of the GNU General Public License as
15 * published by the Free Software Foundation; either version 2 of
16 * the License, or (at your option) any later version.
18 * This program is distributed in the hope that it will be useful,
19 * but WITHOUT ANY WARRANTY; without even the implied warranty of
20 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
21 * GNU General Public License for more details.
23 * You should have received a copy of the GNU General Public License
24 * along with this program; if not, write to the Free Software
25 * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
31 #include <asm/processor.h>
35 #include <asm/fsl_law.h>
37 DECLARE_GLOBAL_DATA_PTR
;
40 extern qe_iop_conf_t qe_iop_conf_tab
[];
41 extern void qe_config_iopin(u8 port
, u8 pin
, int dir
,
42 int open_drain
, int assign
);
43 extern void qe_init(uint qe_base
);
44 extern void qe_reset(void);
46 static void config_qe_ioports(void)
49 int dir
, open_drain
, assign
;
52 for (i
= 0; qe_iop_conf_tab
[i
].assign
!= QE_IOP_TAB_END
; i
++) {
53 port
= qe_iop_conf_tab
[i
].port
;
54 pin
= qe_iop_conf_tab
[i
].pin
;
55 dir
= qe_iop_conf_tab
[i
].dir
;
56 open_drain
= qe_iop_conf_tab
[i
].open_drain
;
57 assign
= qe_iop_conf_tab
[i
].assign
;
58 qe_config_iopin(port
, pin
, dir
, open_drain
, assign
);
64 void config_8560_ioports (volatile ccsr_cpm_t
* cpm
)
68 for (portnum
= 0; portnum
< 4; portnum
++) {
75 iop_conf_t
*iopc
= (iop_conf_t
*) & iop_conf_tab
[portnum
][0];
76 iop_conf_t
*eiopc
= iopc
+ 32;
81 * index 0 refers to pin 31,
82 * index 31 refers to pin 0
84 while (iopc
< eiopc
) {
104 volatile ioport_t
*iop
= ioport_addr (cpm
, portnum
);
108 * the (somewhat confused) paragraph at the
109 * bottom of page 35-5 warns that there might
110 * be "unknown behaviour" when programming
111 * PSORx and PDIRx, if PPARx = 1, so I
112 * decided this meant I had to disable the
113 * dedicated function first, and enable it
117 iop
->psor
= (iop
->psor
& tpmsk
) | psor
;
118 iop
->podr
= (iop
->podr
& tpmsk
) | podr
;
119 iop
->pdat
= (iop
->pdat
& tpmsk
) | pdat
;
120 iop
->pdir
= (iop
->pdir
& tpmsk
) | pdir
;
127 /* We run cpu_init_early_f in AS = 1 */
128 void cpu_init_early_f(void)
130 set_tlb(0, CFG_CCSRBAR
, CFG_CCSRBAR
,
131 MAS3_SX
|MAS3_SW
|MAS3_SR
, MAS2_I
|MAS2_G
,
132 1, 0, BOOKE_PAGESZ_4K
, 0);
134 /* set up CCSR if we want it moved */
135 #if (CFG_CCSRBAR_DEFAULT != CFG_CCSRBAR)
139 set_tlb(0, CFG_CCSRBAR_DEFAULT
, CFG_CCSRBAR_DEFAULT
,
140 MAS3_SX
|MAS3_SW
|MAS3_SR
, MAS2_I
|MAS2_G
,
141 1, 1, BOOKE_PAGESZ_4K
, 0);
143 temp
= in_be32((volatile u32
*)CFG_CCSRBAR_DEFAULT
);
144 out_be32((volatile u32
*)CFG_CCSRBAR_DEFAULT
, CFG_CCSRBAR
>> 12);
146 temp
= in_be32((volatile u32
*)CFG_CCSRBAR
);
156 * Breathe some life into the CPU...
158 * Set up the memory map
159 * initialize a bunch of registers
162 void cpu_init_f (void)
164 volatile ccsr_lbc_t
*memctl
= (void *)(CFG_MPC85xx_LBC_ADDR
);
165 extern void m8560_cpm_reset (void);
170 /* Pointer is writable since we allocated a register for it */
171 gd
= (gd_t
*) (CFG_INIT_RAM_ADDR
+ CFG_GBL_DATA_OFFSET
);
173 /* Clear initial global data */
174 memset ((void *) gd
, 0, sizeof (gd_t
));
177 config_8560_ioports((ccsr_cpm_t
*)CFG_MPC85xx_CPM_ADDR
);
180 /* Map banks 0 and 1 to the FLASH banks 0 and 1 at preliminary
181 * addresses - these have to be modified later when FLASH size
182 * has been determined
184 #if defined(CFG_OR0_REMAP)
185 memctl
->or0
= CFG_OR0_REMAP
;
187 #if defined(CFG_OR1_REMAP)
188 memctl
->or1
= CFG_OR1_REMAP
;
191 /* now restrict to preliminary range */
192 /* if cs1 is already set via debugger, leave cs0/cs1 alone */
193 if (! memctl
->br1
& 1) {
194 #if defined(CFG_BR0_PRELIM) && defined(CFG_OR0_PRELIM)
195 memctl
->br0
= CFG_BR0_PRELIM
;
196 memctl
->or0
= CFG_OR0_PRELIM
;
199 #if defined(CFG_BR1_PRELIM) && defined(CFG_OR1_PRELIM)
200 memctl
->or1
= CFG_OR1_PRELIM
;
201 memctl
->br1
= CFG_BR1_PRELIM
;
205 #if defined(CFG_BR2_PRELIM) && defined(CFG_OR2_PRELIM)
206 memctl
->or2
= CFG_OR2_PRELIM
;
207 memctl
->br2
= CFG_BR2_PRELIM
;
210 #if defined(CFG_BR3_PRELIM) && defined(CFG_OR3_PRELIM)
211 memctl
->or3
= CFG_OR3_PRELIM
;
212 memctl
->br3
= CFG_BR3_PRELIM
;
215 #if defined(CFG_BR4_PRELIM) && defined(CFG_OR4_PRELIM)
216 memctl
->or4
= CFG_OR4_PRELIM
;
217 memctl
->br4
= CFG_BR4_PRELIM
;
220 #if defined(CFG_BR5_PRELIM) && defined(CFG_OR5_PRELIM)
221 memctl
->or5
= CFG_OR5_PRELIM
;
222 memctl
->br5
= CFG_BR5_PRELIM
;
225 #if defined(CFG_BR6_PRELIM) && defined(CFG_OR6_PRELIM)
226 memctl
->or6
= CFG_OR6_PRELIM
;
227 memctl
->br6
= CFG_BR6_PRELIM
;
230 #if defined(CFG_BR7_PRELIM) && defined(CFG_OR7_PRELIM)
231 memctl
->or7
= CFG_OR7_PRELIM
;
232 memctl
->br7
= CFG_BR7_PRELIM
;
235 #if defined(CONFIG_CPM2)
239 /* Config QE ioports */
247 * Initialize L2 as cache.
249 * The newer 8548, etc, parts have twice as much cache, but
250 * use the same bit-encoding as the older 8555, etc, parts.
256 #ifdef CONFIG_CLEAR_LAW0
257 #ifdef CONFIG_FSL_LAW
260 volatile ccsr_local_ecm_t
*ecm
= (void *)(CFG_MPC85xx_ECM_ADDR
);
262 /* clear alternate boot location LAW (used for sdram, or ddr bank) */
267 #if defined(CONFIG_L2_CACHE)
268 volatile ccsr_l2cache_t
*l2cache
= (void *)CFG_MPC85xx_L2_ADDR
;
269 volatile uint cache_ctl
;
277 cache_ctl
= l2cache
->l2ctl
;
279 switch (cache_ctl
& 0x30000000) {
281 if (ver
== SVR_8548
|| ver
== SVR_8548_E
||
282 ver
== SVR_8544
|| ver
== SVR_8568_E
) {
283 printf ("L2 cache 512KB:");
284 /* set L2E=1, L2I=1, & L2SRAM=0 */
285 cache_ctl
= 0xc0000000;
287 printf ("L2 cache 256KB:");
288 /* set L2E=1, L2I=1, & L2BLKSZ=2 (256 Kbyte) */
289 cache_ctl
= 0xc8000000;
293 printf ("L2 cache 256KB:");
294 if (ver
== SVR_8544
|| ver
== SVR_8544_E
) {
295 cache_ctl
= 0xc0000000; /* set L2E=1, L2I=1, & L2SRAM=0 */
301 printf ("L2 cache unknown size (0x%08x)\n", cache_ctl
);
305 if (l2cache
->l2ctl
& 0x80000000) {
306 printf(" already enabled.");
307 l2srbar
= l2cache
->l2srbar0
;
308 #ifdef CFG_INIT_L2_ADDR
309 if (l2cache
->l2ctl
& 0x00010000 && l2srbar
>= CFG_FLASH_BASE
) {
310 l2srbar
= CFG_INIT_L2_ADDR
;
311 l2cache
->l2srbar0
= l2srbar
;
312 printf(" Moving to 0x%08x", CFG_INIT_L2_ADDR
);
314 #endif /* CFG_INIT_L2_ADDR */
318 l2cache
->l2ctl
= cache_ctl
; /* invalidate & enable */
320 printf(" enabled\n");
323 printf("L2 cache: disabled\n");
326 uint qe_base
= CFG_IMMR
+ 0x00080000; /* QE immr base */