1a47a12beSStefan Roese/* 2a47a12beSStefan Roese * Copyright 2008-2010 Freescale Semiconductor, Inc. 3a47a12beSStefan Roese * Kumar Gala <kumar.gala@freescale.com> 4a47a12beSStefan Roese * 5a47a12beSStefan Roese * See file CREDITS for list of people who contributed to this 6a47a12beSStefan Roese * project. 7a47a12beSStefan Roese * 8a47a12beSStefan Roese * This program is free software; you can redistribute it and/or 9a47a12beSStefan Roese * modify it under the terms of the GNU General Public License as 10a47a12beSStefan Roese * published by the Free Software Foundation; either version 2 of 11a47a12beSStefan Roese * the License, or (at your option) any later version. 12a47a12beSStefan Roese * 13a47a12beSStefan Roese * This program is distributed in the hope that it will be useful, 14a47a12beSStefan Roese * but WITHOUT ANY WARRANTY; without even the implied warranty of 15a47a12beSStefan Roese * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 16a47a12beSStefan Roese * GNU General Public License for more details. 17a47a12beSStefan Roese * 18a47a12beSStefan Roese * You should have received a copy of the GNU General Public License 19a47a12beSStefan Roese * along with this program; if not, write to the Free Software 20a47a12beSStefan Roese * Foundation, Inc., 59 Temple Place, Suite 330, Boston, 21a47a12beSStefan Roese * MA 02111-1307 USA 22a47a12beSStefan Roese */ 23a47a12beSStefan Roese 24*25ddd1fbSWolfgang Denk#include <asm-offsets.h> 25a47a12beSStefan Roese#include <config.h> 26a47a12beSStefan Roese#include <mpc85xx.h> 27a47a12beSStefan Roese#include <version.h> 28a47a12beSStefan Roese 29a47a12beSStefan Roese#define _LINUX_CONFIG_H 1 /* avoid reading Linux autoconf.h file */ 30a47a12beSStefan Roese 31a47a12beSStefan Roese#include <ppc_asm.tmpl> 32a47a12beSStefan Roese#include <ppc_defs.h> 33a47a12beSStefan Roese 34a47a12beSStefan Roese#include <asm/cache.h> 35a47a12beSStefan Roese#include <asm/mmu.h> 36a47a12beSStefan Roese 37a47a12beSStefan Roese/* To boot secondary cpus, we need a place for them to start up. 38a47a12beSStefan Roese * Normally, they start at 0xfffffffc, but that's usually the 39a47a12beSStefan Roese * firmware, and we don't want to have to run the firmware again. 40a47a12beSStefan Roese * Instead, the primary cpu will set the BPTR to point here to 41a47a12beSStefan Roese * this page. We then set up the core, and head to 42a47a12beSStefan Roese * start_secondary. Note that this means that the code below 43a47a12beSStefan Roese * must never exceed 1023 instructions (the branch at the end 44a47a12beSStefan Roese * would then be the 1024th). 45a47a12beSStefan Roese */ 46a47a12beSStefan Roese .globl __secondary_start_page 47a47a12beSStefan Roese .align 12 48a47a12beSStefan Roese__secondary_start_page: 49a47a12beSStefan Roese/* First do some preliminary setup */ 50a47a12beSStefan Roese lis r3, HID0_EMCP@h /* enable machine check */ 51a47a12beSStefan Roese#ifndef CONFIG_E500MC 52a47a12beSStefan Roese ori r3,r3,HID0_TBEN@l /* enable Timebase */ 53a47a12beSStefan Roese#endif 54a47a12beSStefan Roese#ifdef CONFIG_PHYS_64BIT 55a47a12beSStefan Roese ori r3,r3,HID0_ENMAS7@l /* enable MAS7 updates */ 56a47a12beSStefan Roese#endif 57a47a12beSStefan Roese mtspr SPRN_HID0,r3 58a47a12beSStefan Roese 59a47a12beSStefan Roese#ifndef CONFIG_E500MC 60a47a12beSStefan Roese li r3,(HID1_ASTME|HID1_ABE)@l /* Addr streaming & broadcast */ 61a47a12beSStefan Roese mfspr r0,PVR 62a47a12beSStefan Roese andi. r0,r0,0xff 63a47a12beSStefan Roese cmpwi r0,0x50@l /* if we are rev 5.0 or greater set MBDD */ 64a47a12beSStefan Roese blt 1f 65a47a12beSStefan Roese /* Set MBDD bit also */ 66a47a12beSStefan Roese ori r3, r3, HID1_MBDD@l 67a47a12beSStefan Roese1: 68a47a12beSStefan Roese mtspr SPRN_HID1,r3 69a47a12beSStefan Roese#endif 70a47a12beSStefan Roese 71a47a12beSStefan Roese /* Enable branch prediction */ 72a47a12beSStefan Roese lis r3,BUCSR_ENABLE@h 73a47a12beSStefan Roese ori r3,r3,BUCSR_ENABLE@l 74a47a12beSStefan Roese mtspr SPRN_BUCSR,r3 75a47a12beSStefan Roese 76a47a12beSStefan Roese /* Ensure TB is 0 */ 77a47a12beSStefan Roese li r3,0 78a47a12beSStefan Roese mttbl r3 79a47a12beSStefan Roese mttbu r3 80a47a12beSStefan Roese 81a47a12beSStefan Roese /* Enable/invalidate the I-Cache */ 82a47a12beSStefan Roese lis r2,(L1CSR1_ICFI|L1CSR1_ICLFR)@h 83a47a12beSStefan Roese ori r2,r2,(L1CSR1_ICFI|L1CSR1_ICLFR)@l 84a47a12beSStefan Roese mtspr SPRN_L1CSR1,r2 85a47a12beSStefan Roese1: 86a47a12beSStefan Roese mfspr r3,SPRN_L1CSR1 87a47a12beSStefan Roese and. r1,r3,r2 88a47a12beSStefan Roese bne 1b 89a47a12beSStefan Roese 90a47a12beSStefan Roese lis r3,(L1CSR1_CPE|L1CSR1_ICE)@h 91a47a12beSStefan Roese ori r3,r3,(L1CSR1_CPE|L1CSR1_ICE)@l 92a47a12beSStefan Roese mtspr SPRN_L1CSR1,r3 93a47a12beSStefan Roese isync 94a47a12beSStefan Roese2: 95a47a12beSStefan Roese mfspr r3,SPRN_L1CSR1 96a47a12beSStefan Roese andi. r1,r3,L1CSR1_ICE@l 97a47a12beSStefan Roese beq 2b 98a47a12beSStefan Roese 99a47a12beSStefan Roese /* Enable/invalidate the D-Cache */ 100a47a12beSStefan Roese lis r2,(L1CSR0_DCFI|L1CSR0_DCLFR)@h 101a47a12beSStefan Roese ori r2,r2,(L1CSR0_DCFI|L1CSR0_DCLFR)@l 102a47a12beSStefan Roese mtspr SPRN_L1CSR0,r2 103a47a12beSStefan Roese1: 104a47a12beSStefan Roese mfspr r3,SPRN_L1CSR0 105a47a12beSStefan Roese and. r1,r3,r2 106a47a12beSStefan Roese bne 1b 107a47a12beSStefan Roese 108a47a12beSStefan Roese lis r3,(L1CSR0_CPE|L1CSR0_DCE)@h 109a47a12beSStefan Roese ori r3,r3,(L1CSR0_CPE|L1CSR0_DCE)@l 110a47a12beSStefan Roese mtspr SPRN_L1CSR0,r3 111a47a12beSStefan Roese isync 112a47a12beSStefan Roese2: 113a47a12beSStefan Roese mfspr r3,SPRN_L1CSR0 114a47a12beSStefan Roese andi. r1,r3,L1CSR0_DCE@l 115a47a12beSStefan Roese beq 2b 116a47a12beSStefan Roese 117a47a12beSStefan Roese#define toreset(x) (x - __secondary_start_page + 0xfffff000) 118a47a12beSStefan Roese 119a47a12beSStefan Roese /* get our PIR to figure out our table entry */ 120a47a12beSStefan Roese lis r3,toreset(__spin_table)@h 121a47a12beSStefan Roese ori r3,r3,toreset(__spin_table)@l 122a47a12beSStefan Roese 123a47a12beSStefan Roese /* r10 has the base address for the entry */ 124a47a12beSStefan Roese mfspr r0,SPRN_PIR 125a47a12beSStefan Roese#ifdef CONFIG_E500MC 126a47a12beSStefan Roese rlwinm r4,r0,27,27,31 127a47a12beSStefan Roese#else 128a47a12beSStefan Roese mr r4,r0 129a47a12beSStefan Roese#endif 130a47a12beSStefan Roese slwi r8,r4,5 131a47a12beSStefan Roese add r10,r3,r8 132a47a12beSStefan Roese 133a47a12beSStefan Roese#if defined(CONFIG_E500MC) && defined(CONFIG_SYS_CACHE_STASHING) 134a47a12beSStefan Roese /* set stash id to (coreID) * 2 + 32 + L1 CT (0) */ 135a47a12beSStefan Roese slwi r8,r4,1 136a47a12beSStefan Roese addi r8,r8,32 137a47a12beSStefan Roese mtspr L1CSR2,r8 138a47a12beSStefan Roese#endif 139a47a12beSStefan Roese 140fd3c9befSKumar Gala#if defined(CONFIG_SYS_P4080_ERRATUM_CPU22) 141fd3c9befSKumar Gala mfspr r8,L1CSR2 142fd3c9befSKumar Gala oris r8,r8,(L1CSR2_DCWS)@h 143fd3c9befSKumar Gala mtspr L1CSR2,r8 144fd3c9befSKumar Gala#endif 145fd3c9befSKumar Gala 146a47a12beSStefan Roese#ifdef CONFIG_BACKSIDE_L2_CACHE 147a47a12beSStefan Roese /* Enable/invalidate the L2 cache */ 148a47a12beSStefan Roese msync 149a47a12beSStefan Roese lis r2,(L2CSR0_L2FI|L2CSR0_L2LFC)@h 150a47a12beSStefan Roese ori r2,r2,(L2CSR0_L2FI|L2CSR0_L2LFC)@l 151a47a12beSStefan Roese mtspr SPRN_L2CSR0,r2 152a47a12beSStefan Roese1: 153a47a12beSStefan Roese mfspr r3,SPRN_L2CSR0 154a47a12beSStefan Roese and. r1,r3,r2 155a47a12beSStefan Roese bne 1b 156a47a12beSStefan Roese 157a47a12beSStefan Roese#ifdef CONFIG_SYS_CACHE_STASHING 158a47a12beSStefan Roese /* set stash id to (coreID) * 2 + 32 + L2 (1) */ 159a47a12beSStefan Roese addi r3,r8,1 160a47a12beSStefan Roese mtspr SPRN_L2CSR1,r3 161a47a12beSStefan Roese#endif 162a47a12beSStefan Roese 163a47a12beSStefan Roese lis r3,CONFIG_SYS_INIT_L2CSR0@h 164a47a12beSStefan Roese ori r3,r3,CONFIG_SYS_INIT_L2CSR0@l 165a47a12beSStefan Roese mtspr SPRN_L2CSR0,r3 166a47a12beSStefan Roese isync 167a47a12beSStefan Roese2: 168a47a12beSStefan Roese mfspr r3,SPRN_L2CSR0 169a47a12beSStefan Roese andis. r1,r3,L2CSR0_L2E@h 170a47a12beSStefan Roese beq 2b 171a47a12beSStefan Roese#endif 172a47a12beSStefan Roese 173a47a12beSStefan Roese#define EPAPR_MAGIC (0x45504150) 174a47a12beSStefan Roese#define ENTRY_ADDR_UPPER 0 175a47a12beSStefan Roese#define ENTRY_ADDR_LOWER 4 176a47a12beSStefan Roese#define ENTRY_R3_UPPER 8 177a47a12beSStefan Roese#define ENTRY_R3_LOWER 12 178a47a12beSStefan Roese#define ENTRY_RESV 16 179a47a12beSStefan Roese#define ENTRY_PIR 20 180a47a12beSStefan Roese#define ENTRY_R6_UPPER 24 181a47a12beSStefan Roese#define ENTRY_R6_LOWER 28 182a47a12beSStefan Roese#define ENTRY_SIZE 32 183a47a12beSStefan Roese 184a47a12beSStefan Roese /* setup the entry */ 185a47a12beSStefan Roese li r3,0 186a47a12beSStefan Roese li r8,1 187a47a12beSStefan Roese stw r0,ENTRY_PIR(r10) 188a47a12beSStefan Roese stw r3,ENTRY_ADDR_UPPER(r10) 189a47a12beSStefan Roese stw r8,ENTRY_ADDR_LOWER(r10) 190a47a12beSStefan Roese stw r3,ENTRY_R3_UPPER(r10) 191a47a12beSStefan Roese stw r4,ENTRY_R3_LOWER(r10) 192a47a12beSStefan Roese stw r3,ENTRY_R6_UPPER(r10) 193a47a12beSStefan Roese stw r3,ENTRY_R6_LOWER(r10) 194a47a12beSStefan Roese 195a47a12beSStefan Roese /* load r13 with the address of the 'bootpg' in SDRAM */ 196a47a12beSStefan Roese lis r13,toreset(__bootpg_addr)@h 197a47a12beSStefan Roese ori r13,r13,toreset(__bootpg_addr)@l 198a47a12beSStefan Roese lwz r13,0(r13) 199a47a12beSStefan Roese 200a47a12beSStefan Roese /* setup mapping for AS = 1, and jump there */ 201a47a12beSStefan Roese lis r11,(MAS0_TLBSEL(1)|MAS0_ESEL(1))@h 202a47a12beSStefan Roese mtspr SPRN_MAS0,r11 203a47a12beSStefan Roese lis r11,(MAS1_VALID|MAS1_IPROT)@h 204a47a12beSStefan Roese ori r11,r11,(MAS1_TS|MAS1_TSIZE(BOOKE_PAGESZ_4K))@l 205a47a12beSStefan Roese mtspr SPRN_MAS1,r11 206a47a12beSStefan Roese oris r11,r13,(MAS2_I|MAS2_G)@h 207a47a12beSStefan Roese ori r11,r13,(MAS2_I|MAS2_G)@l 208a47a12beSStefan Roese mtspr SPRN_MAS2,r11 209a47a12beSStefan Roese oris r11,r13,(MAS3_SX|MAS3_SW|MAS3_SR)@h 210a47a12beSStefan Roese ori r11,r13,(MAS3_SX|MAS3_SW|MAS3_SR)@l 211a47a12beSStefan Roese mtspr SPRN_MAS3,r11 212a47a12beSStefan Roese tlbwe 213a47a12beSStefan Roese 214a47a12beSStefan Roese bl 1f 215a47a12beSStefan Roese1: mflr r11 216a47a12beSStefan Roese /* 217a47a12beSStefan Roese * OR in 0xfff to create a mask of the bootpg SDRAM address. We use 218a47a12beSStefan Roese * this mask to fixup the cpu spin table and the address that we want 219a47a12beSStefan Roese * to jump to, eg change them from 0xfffffxxx to 0x7ffffxxx if the 220a47a12beSStefan Roese * bootpg is at 0x7ffff000 in SDRAM. 221a47a12beSStefan Roese */ 222a47a12beSStefan Roese ori r13,r13,0xfff 223a47a12beSStefan Roese and r11, r11, r13 224a47a12beSStefan Roese and r10, r10, r13 225a47a12beSStefan Roese 226a47a12beSStefan Roese addi r11,r11,(2f-1b) 227a47a12beSStefan Roese mfmsr r13 228a47a12beSStefan Roese ori r12,r13,MSR_IS|MSR_DS@l 229a47a12beSStefan Roese 230a47a12beSStefan Roese mtspr SPRN_SRR0,r11 231a47a12beSStefan Roese mtspr SPRN_SRR1,r12 232a47a12beSStefan Roese rfi 233a47a12beSStefan Roese 234a47a12beSStefan Roese /* spin waiting for addr */ 235a47a12beSStefan Roese2: 236a47a12beSStefan Roese lwz r4,ENTRY_ADDR_LOWER(r10) 237a47a12beSStefan Roese andi. r11,r4,1 238a47a12beSStefan Roese bne 2b 239a47a12beSStefan Roese isync 240a47a12beSStefan Roese 241a47a12beSStefan Roese /* setup IVORs to match fixed offsets */ 242a47a12beSStefan Roese#include "fixed_ivor.S" 243a47a12beSStefan Roese 244a47a12beSStefan Roese /* get the upper bits of the addr */ 245a47a12beSStefan Roese lwz r11,ENTRY_ADDR_UPPER(r10) 246a47a12beSStefan Roese 247a47a12beSStefan Roese /* setup branch addr */ 248a47a12beSStefan Roese mtspr SPRN_SRR0,r4 249a47a12beSStefan Roese 250a47a12beSStefan Roese /* mark the entry as released */ 251a47a12beSStefan Roese li r8,3 252a47a12beSStefan Roese stw r8,ENTRY_ADDR_LOWER(r10) 253a47a12beSStefan Roese 254a47a12beSStefan Roese /* mask by ~64M to setup our tlb we will jump to */ 255a47a12beSStefan Roese rlwinm r12,r4,0,0,5 256a47a12beSStefan Roese 257a47a12beSStefan Roese /* setup r3, r4, r5, r6, r7, r8, r9 */ 258a47a12beSStefan Roese lwz r3,ENTRY_R3_LOWER(r10) 259a47a12beSStefan Roese li r4,0 260a47a12beSStefan Roese li r5,0 261a47a12beSStefan Roese lwz r6,ENTRY_R6_LOWER(r10) 262a47a12beSStefan Roese lis r7,(64*1024*1024)@h 263a47a12beSStefan Roese li r8,0 264a47a12beSStefan Roese li r9,0 265a47a12beSStefan Roese 266a47a12beSStefan Roese /* load up the pir */ 267a47a12beSStefan Roese lwz r0,ENTRY_PIR(r10) 268a47a12beSStefan Roese mtspr SPRN_PIR,r0 269a47a12beSStefan Roese mfspr r0,SPRN_PIR 270a47a12beSStefan Roese stw r0,ENTRY_PIR(r10) 271a47a12beSStefan Roese 272a47a12beSStefan Roese mtspr IVPR,r12 273a47a12beSStefan Roese/* 274a47a12beSStefan Roese * Coming here, we know the cpu has one TLB mapping in TLB1[0] 275a47a12beSStefan Roese * which maps 0xfffff000-0xffffffff one-to-one. We set up a 276a47a12beSStefan Roese * second mapping that maps addr 1:1 for 64M, and then we jump to 277a47a12beSStefan Roese * addr 278a47a12beSStefan Roese */ 279a47a12beSStefan Roese lis r10,(MAS0_TLBSEL(1)|MAS0_ESEL(0))@h 280a47a12beSStefan Roese mtspr SPRN_MAS0,r10 281a47a12beSStefan Roese lis r10,(MAS1_VALID|MAS1_IPROT)@h 282a47a12beSStefan Roese ori r10,r10,(MAS1_TSIZE(BOOKE_PAGESZ_64M))@l 283a47a12beSStefan Roese mtspr SPRN_MAS1,r10 284a47a12beSStefan Roese /* WIMGE = 0b00000 for now */ 285a47a12beSStefan Roese mtspr SPRN_MAS2,r12 286a47a12beSStefan Roese ori r12,r12,(MAS3_SX|MAS3_SW|MAS3_SR) 287a47a12beSStefan Roese mtspr SPRN_MAS3,r12 288a47a12beSStefan Roese#ifdef CONFIG_ENABLE_36BIT_PHYS 289a47a12beSStefan Roese mtspr SPRN_MAS7,r11 290a47a12beSStefan Roese#endif 291a47a12beSStefan Roese tlbwe 292a47a12beSStefan Roese 293a47a12beSStefan Roese/* Now we have another mapping for this page, so we jump to that 294a47a12beSStefan Roese * mapping 295a47a12beSStefan Roese */ 296a47a12beSStefan Roese mtspr SPRN_SRR1,r13 297a47a12beSStefan Roese rfi 298a47a12beSStefan Roese 299a47a12beSStefan Roese /* 300a47a12beSStefan Roese * Allocate some space for the SDRAM address of the bootpg. 301a47a12beSStefan Roese * This variable has to be in the boot page so that it can 302a47a12beSStefan Roese * be accessed by secondary cores when they come out of reset. 303a47a12beSStefan Roese */ 304a47a12beSStefan Roese .globl __bootpg_addr 305a47a12beSStefan Roese__bootpg_addr: 306a47a12beSStefan Roese .long 0 307a47a12beSStefan Roese 308a47a12beSStefan Roese .align L1_CACHE_SHIFT 309a47a12beSStefan Roese .globl __spin_table 310a47a12beSStefan Roese__spin_table: 311a47a12beSStefan Roese .space CONFIG_MAX_CPUS*ENTRY_SIZE 312a47a12beSStefan Roese 313a47a12beSStefan Roese /* Fill in the empty space. The actual reset vector is 314a47a12beSStefan Roese * the last word of the page */ 315a47a12beSStefan Roese__secondary_start_code_end: 316a47a12beSStefan Roese .space 4092 - (__secondary_start_code_end - __secondary_start_page) 317a47a12beSStefan Roese__secondary_reset_vector: 318a47a12beSStefan Roese b __secondary_start_page 319